mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-06-05 23:49:00 +08:00
bound trim values at 10% of max command value
This commit is contained in:
@@ -32,8 +32,8 @@
|
||||
<dl_settings NAME="control">
|
||||
|
||||
<dl_settings NAME="trim">
|
||||
<dl_setting MAX="3000" MIN="-3000" STEP="1" VAR="command_roll_trim" shortname="roll_trim" module="commands" param="COMMAND_ROLL_TRIM"/>
|
||||
<dl_setting MAX="3000" MIN="-3000" STEP="1" VAR="command_pitch_trim" shortname="pitch_trim" param="COMMAND_PITCH_TRIM"/>
|
||||
<dl_setting MAX="960" MIN="-960" STEP="1" VAR="command_roll_trim" shortname="roll_trim" module="commands" param="COMMAND_ROLL_TRIM"/>
|
||||
<dl_setting MAX="960" MIN="-960" STEP="1" VAR="command_pitch_trim" shortname="pitch_trim" param="COMMAND_PITCH_TRIM"/>
|
||||
</dl_settings>
|
||||
|
||||
<dl_settings NAME="attitude">
|
||||
|
||||
@@ -32,8 +32,8 @@
|
||||
<dl_settings NAME="control">
|
||||
|
||||
<dl_settings NAME="trim">
|
||||
<dl_setting MAX="3000" MIN="-3000" STEP="1" VAR="command_roll_trim" shortname="roll_trim" module="commands" param="COMMAND_ROLL_TRIM"/>
|
||||
<dl_setting MAX="3000" MIN="-3000" STEP="1" VAR="command_pitch_trim" shortname="pitch_trim" param="COMMAND_PITCH_TRIM"/>
|
||||
<dl_setting MAX="960" MIN="-960" STEP="1" VAR="command_roll_trim" shortname="roll_trim" module="commands" param="COMMAND_ROLL_TRIM"/>
|
||||
<dl_setting MAX="960" MIN="-960" STEP="1" VAR="command_pitch_trim" shortname="pitch_trim" param="COMMAND_PITCH_TRIM"/>
|
||||
</dl_settings>
|
||||
|
||||
<dl_settings NAME="ins">
|
||||
|
||||
@@ -155,10 +155,10 @@ void event_task_fbw( void) {
|
||||
for(i = 0; i < COMMANDS_NB; i++) trimmed_commands[i] = commands[i];
|
||||
|
||||
#ifdef COMMAND_ROLL
|
||||
trimmed_commands[COMMAND_ROLL] += command_roll_trim;
|
||||
trimmed_commands[COMMAND_ROLL] += ChopAbs(command_roll_trim, MAX_PPRZ/10);
|
||||
#endif
|
||||
#ifdef COMMAND_PITCH
|
||||
trimmed_commands[COMMAND_PITCH] += command_pitch_trim;
|
||||
trimmed_commands[COMMAND_PITCH] += ChopAbs(command_pitch_trim, MAX_PPRZ/10);
|
||||
#endif
|
||||
|
||||
SetActuatorsFromCommands(trimmed_commands);
|
||||
|
||||
Reference in New Issue
Block a user