VOXL2 board support updates (#21426)

This commit is contained in:
Eric Katzfey
2023-04-19 11:21:02 -04:00
committed by GitHub
parent cb66c48876
commit 018ca6b49d
17 changed files with 755 additions and 141 deletions
+13 -2
View File
@@ -93,8 +93,13 @@ extern "C" {
if (name == NULL) { return -1; }
memcpy(attr->name, name, PTHREAD_NAME_LEN);
attr->name[PTHREAD_NAME_LEN - 1] = 0;
size_t name_len = strlen(name);
if (name_len > PX4_TASK_MAX_NAME_LENGTH) { name_len = PX4_TASK_MAX_NAME_LENGTH; }
memcpy(attr->name, name, name_len);
attr->name[name_len] = 0;
return 0;
}
@@ -424,14 +429,20 @@ int px4_sem_timedwait(px4_sem_t *sem, const struct timespec *ts)
int px4_prctl(int option, const char *arg2, px4_task_t pid)
{
int rv = -1;
if (option != PR_SET_NAME) { return rv; }
pthread_mutex_lock(&task_mutex);
for (int i = 0; i < PX4_MAX_TASKS; i++) {
if (taskmap[i].isused && taskmap[i].tid == (pthread_t) pid) {
rv = pthread_attr_setthreadname(&taskmap[i].attr, arg2);
pthread_mutex_unlock(&task_mutex);
return rv;
}
}
pthread_mutex_unlock(&task_mutex);
return rv;
}