You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
85 lines
2.2 KiB
85 lines
2.2 KiB
9 years ago
|
/// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*-
|
||
|
|
/*
|
||
|
|
* Copyright (C) 2016 Intel Corporation. All rights reserved.
|
||
|
|
*
|
||
|
|
* This file is free software: you can redistribute it and/or modify it
|
||
|
|
* under the terms of the GNU General Public License as published by the
|
||
|
|
* Free Software Foundation, either version 3 of the License, or
|
||
|
|
* (at your option) any later version.
|
||
|
|
*
|
||
|
|
* This file is distributed in the hope that it will be useful, but
|
||
|
|
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
|
||
|
|
* See the GNU General Public License for more details.
|
||
|
|
*
|
||
|
|
* You should have received a copy of the GNU General Public License along
|
||
|
|
* with this program. If not, see <http://www.gnu.org/licenses/>.
|
||
|
|
*/
|
||
|
|
#include "Thread.h"
|
||
|
|
|
||
|
|
#include <sys/types.h>
|
||
|
|
#include <unistd.h>
|
||
|
|
|
||
|
|
#include <AP_HAL/AP_HAL.h>
|
||
|
|
#include <AP_Math/AP_Math.h>
|
||
|
|
|
||
|
|
#include "Scheduler.h"
|
||
|
|
|
||
|
|
extern const AP_HAL::HAL &hal;
|
||
|
|
|
||
|
|
namespace Linux {
|
||
|
|
|
||
|
|
|
||
|
|
void *Thread::_run_trampoline(void *arg)
|
||
|
|
{
|
||
|
|
Thread *thread = static_cast<Thread *>(arg);
|
||
|
|
|
||
|
|
thread->_task();
|
||
|
|
|
||
|
|
return nullptr;
|
||
|
|
}
|
||
|
|
|
||
|
|
bool Thread::start(const char *name, int policy, int prio)
|
||
|
|
{
|
||
|
|
if (_started) {
|
||
|
|
return false;
|
||
|
|
}
|
||
|
|
|
||
|
|
struct sched_param param = { .sched_priority = prio };
|
||
|
|
pthread_attr_t attr;
|
||
|
|
int r;
|
||
|
|
|
||
|
|
pthread_attr_init(&attr);
|
||
|
|
|
||
|
|
/*
|
||
|
|
we need to run as root to get realtime scheduling. Allow it to
|
||
|
|
run as non-root for debugging purposes, plus to allow the Replay
|
||
|
|
tool to run
|
||
|
|
*/
|
||
|
|
if (geteuid() == 0) {
|
||
|
|
if ((r = pthread_attr_setinheritsched(&attr, PTHREAD_EXPLICIT_SCHED)) != 0 ||
|
||
|
|
(r = pthread_attr_setschedpolicy(&attr, policy)) != 0 ||
|
||
|
|
(r = pthread_attr_setschedparam(&attr, ¶m) != 0)) {
|
||
|
|
AP_HAL::panic("Failed to set attributes for thread '%s': %s",
|
||
|
|
name, strerror(r));
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
r = pthread_create(&_ctx, &attr, &Thread::_run_trampoline, this);
|
||
|
|
if (r != 0) {
|
||
|
|
AP_HAL::panic("Failed to create thread '%s': %s",
|
||
|
|
name, strerror(r));
|
||
|
|
}
|
||
|
|
pthread_attr_destroy(&attr);
|
||
|
|
|
||
|
|
if (name) {
|
||
|
|
pthread_setname_np(_ctx, name);
|
||
|
|
}
|
||
|
|
|
||
|
|
_started = true;
|
||
|
|
|
||
|
|
return true;
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|