philip/MDH-UAV-Control-System
Archived
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Fix for motormix low. Not tested!

Browse Source
This commit is contained in:
philsson 2016-10-25 09:17:45 +02:00
parent 1ef8f56ed6
commit 4da4736257
1 changed files with 7 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
UAV-ControlSystem/src/drivers/motormix.c
View File

@ -199,6 +199,10 @@ void mix()
PidProfile[PID_ID_GYRO].PID_Out[YAW] * mixerUAV[i].yaw * ((mixerConfig.yaw_reverse_direction) ? -1 : 1);
}
for (int i = 0; i < MOTOR_COUNT; i++)
// Find the minimum and maximum motor output
if (RPY_Mix[i] < RPY_Mix_Min) RPY_Mix_Min = RPY_Mix[i];
/* Mixer Low Scale - Scaling output around low throttle */
if (flags_IsSet_ID(systemFlags_mixerlowscale_id))
@ -219,6 +223,9 @@ void mix()
}
}
/* Recalculating RPY_Mix_Min */
RPY_Mix_Min = throttleMid;
for (int i = 0; i < MOTOR_COUNT; i++)
{
// Find the minimum and maximum motor output