Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-23 16:25:31 +03:00
Code Issues Wiki Activity

Add Attitude task

Browse source
This commit is contained in:
borisbstyle 2016-03-02 00:10:29 +01:00
parent eb04e2c745
commit 24b4d37d43
4 changed files with 14 additions and 1 deletions
Download patch file Download diff file Expand all files Collapse all files

1
src/main/main.c
View file

@ -696,6 +696,7 @@ int main(void) {
rescheduleTask(TASK_ACCEL, accTargetLooptime);
}
setTaskEnabled(TASK_ACCEL, sensors(SENSOR_ACC));
setTaskEnabled(TASK_ATTITUDE, sensors(SENSOR_ACC));
setTaskEnabled(TASK_SERIAL, true);
#ifdef BEEPER
setTaskEnabled(TASK_BEEPER, true);

5
src/main/mw.c
View file

@ -657,7 +657,6 @@ void taskMainPidLoop(void)
}
void subTasksMainPidLoop(void) {
imuUpdateAttitude();
if (masterConfig.rxConfig.rcSmoothing || flightModeFlags) {
filterRc();
@ -791,6 +790,10 @@ void taskUpdateAccelerometer(void)
imuUpdateAccelerometer(&masterConfig.accelerometerTrims);
}
void taskUpdateAttitude(void) {
imuUpdateAttitude();
}
void taskHandleSerial(void)
{
handleSerial();

1
src/main/scheduler.h
View file

@ -45,6 +45,7 @@ typedef enum {
TASK_SYSTEM = 0,
TASK_GYROPID,
TASK_MOTOR,
TASK_ATTITUDE,
TASK_ACCEL,
TASK_SERIAL,
#ifdef BEEPER

8
src/main/scheduler_tasks.c
View file

@ -26,6 +26,7 @@ void taskMainPidLoopCheck(void);
void taskMotorUpdate(void);
void taskUpdateAccelerometer(void);
void taskHandleSerial(void);
void taskUpdateAttitude(void);
void taskUpdateBeeper(void);
void taskUpdateBattery(void);
bool taskUpdateRxCheck(uint32_t currentDeltaTime);
@ -68,6 +69,13 @@ cfTask_t cfTasks[TASK_COUNT] = {
.staticPriority = TASK_PRIORITY_REALTIME,
},
[TASK_ATTITUDE] = {
.taskName = "ATTITUDE",
.taskFunc = taskUpdateAttitude,
.desiredPeriod = 1000000 / 100,
.staticPriority = TASK_PRIORITY_MEDIUM,
},
[TASK_ACCEL] = {
.taskName = "ACCEL",
.taskFunc = taskUpdateAccelerometer,