aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

This is the test to deal with big props with lots of inertia. We use a low pass filter on positive acceleration.

Browse Source
This commit is contained in:
Jason Short 2011-12-23 14:29:07 -08:00
parent fa2fa37f3b
commit ce11f48809
5 changed files with 95 additions and 32 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

25
ArduCopter/motors_hexa.pde
View File

@ -97,12 +97,25 @@ static void output_motors_armed()
} }
#endif #endif
APM_RC.OutputCh(CH_1, motor_out[CH_1]); // this filter slows the acceleration of motors vs the deceleration
APM_RC.OutputCh(CH_2, motor_out[CH_2]); // Idea by Denny Rowland to help with his Yaw issue
APM_RC.OutputCh(CH_3, motor_out[CH_3]); for(int8_t i = CH_1; i <= CH_8; i++ ) {
APM_RC.OutputCh(CH_4, motor_out[CH_4]); if(i == CH_5 || i == CH_6)
APM_RC.OutputCh(CH_7, motor_out[CH_7]); continue;
APM_RC.OutputCh(CH_8, motor_out[CH_8]); if(motor_filtered[i] < motor_out[i]){
motor_filtered[i] = (motor_out[i] + motor_filtered[i]) / 2;
}else{
// don't filter
motor_filtered[i] = motor_out[i];
}
}
APM_RC.OutputCh(CH_1, motor_filtered[CH_1]);
APM_RC.OutputCh(CH_2, motor_filtered[CH_2]);
APM_RC.OutputCh(CH_3, motor_filtered[CH_3]);
APM_RC.OutputCh(CH_4, motor_filtered[CH_4]);
APM_RC.OutputCh(CH_7, motor_filtered[CH_7]);
APM_RC.OutputCh(CH_8, motor_filtered[CH_8]);
#if INSTANT_PWM == 1 #if INSTANT_PWM == 1
// InstantPWM // InstantPWM

29
ArduCopter/motors_octa.pde
View File

@ -148,14 +148,27 @@ static void output_motors_armed()
} }
#endif #endif
APM_RC.OutputCh(CH_1, motor_out[CH_1]); // this filter slows the acceleration of motors vs the deceleration
APM_RC.OutputCh(CH_2, motor_out[CH_2]); // Idea by Denny Rowland to help with his Yaw issue
APM_RC.OutputCh(CH_3, motor_out[CH_3]); for(int8_t i = CH_1; i <= CH_11; i++ ) {
APM_RC.OutputCh(CH_4, motor_out[CH_4]); if(i == CH_5 || i == CH_6 || i == CH_9)
APM_RC.OutputCh(CH_7, motor_out[CH_7]); continue;
APM_RC.OutputCh(CH_8, motor_out[CH_8]); if(motor_filtered[i] < motor_out[i]){
APM_RC.OutputCh(CH_10, motor_out[CH_10]); motor_filtered[i] = (motor_out[i] + motor_filtered[i]) / 2;
APM_RC.OutputCh(CH_11, motor_out[CH_11]); }else{
// don't filter
motor_filtered[i] = motor_out[i];
}
}
APM_RC.OutputCh(CH_1, motor_filtered[CH_1]);
APM_RC.OutputCh(CH_2, motor_filtered[CH_2]);
APM_RC.OutputCh(CH_3, motor_filtered[CH_3]);
APM_RC.OutputCh(CH_4, motor_filtered[CH_4]);
APM_RC.OutputCh(CH_7, motor_filtered[CH_7]);
APM_RC.OutputCh(CH_8, motor_filtered[CH_8]);
APM_RC.OutputCh(CH_10, motor_filtered[CH_10]);
APM_RC.OutputCh(CH_11, motor_filtered[CH_11]);
#if INSTANT_PWM == 1 #if INSTANT_PWM == 1
// InstantPWM // InstantPWM

29
ArduCopter/motors_octa_quad.pde
View File

@ -116,14 +116,27 @@ static void output_motors_armed()
} }
#endif #endif
APM_RC.OutputCh(CH_1, motor_out[CH_1]); // this filter slows the acceleration of motors vs the deceleration
APM_RC.OutputCh(CH_2, motor_out[CH_2]); // Idea by Denny Rowland to help with his Yaw issue
APM_RC.OutputCh(CH_3, motor_out[CH_3]); for(int8_t i = CH_1; i <= CH_11; i++ ) {
APM_RC.OutputCh(CH_4, motor_out[CH_4]); if(i == CH_5 || i == CH_6 || i == CH_9)
APM_RC.OutputCh(CH_7, motor_out[CH_7]); continue;
APM_RC.OutputCh(CH_8, motor_out[CH_8]); if(motor_filtered[i] < motor_out[i]){
APM_RC.OutputCh(CH_10, motor_out[CH_10]); motor_filtered[i] = (motor_out[i] + motor_filtered[i]) / 2;
APM_RC.OutputCh(CH_11, motor_out[CH_11]); }else{
// don't filter
motor_filtered[i] = motor_out[i];
}
}
APM_RC.OutputCh(CH_1, motor_filtered[CH_1]);
APM_RC.OutputCh(CH_2, motor_filtered[CH_2]);
APM_RC.OutputCh(CH_3, motor_filtered[CH_3]);
APM_RC.OutputCh(CH_4, motor_filtered[CH_4]);
APM_RC.OutputCh(CH_7, motor_filtered[CH_7]);
APM_RC.OutputCh(CH_8, motor_filtered[CH_8]);
APM_RC.OutputCh(CH_10, motor_filtered[CH_10]);
APM_RC.OutputCh(CH_11, motor_filtered[CH_11]);
#if INSTANT_PWM == 1 #if INSTANT_PWM == 1
// InstantPWM // InstantPWM

19
ArduCopter/motors_quad.pde
View File

@ -89,10 +89,21 @@ static void output_motors_armed()
} }
#endif #endif
APM_RC.OutputCh(CH_1, motor_out[CH_1]); // this filter slows the acceleration of motors vs the deceleration
APM_RC.OutputCh(CH_2, motor_out[CH_2]); // Idea by Denny Rowland to help with his Yaw issue
APM_RC.OutputCh(CH_3, motor_out[CH_3]); for(int8_t i=CH_1; i <= CH_4; i++ ) {
APM_RC.OutputCh(CH_4, motor_out[CH_4]); if(motor_filtered[i] < motor_out[i]){
motor_filtered[i] = (motor_out[i] + motor_filtered[i]) / 2;
}else{
// don't filter
motor_filtered[i] = motor_out[i];
}
}
APM_RC.OutputCh(CH_1, motor_filtered[CH_1]);
APM_RC.OutputCh(CH_2, motor_filtered[CH_2]);
APM_RC.OutputCh(CH_3, motor_filtered[CH_3]);
APM_RC.OutputCh(CH_4, motor_filtered[CH_4]);
#if INSTANT_PWM == 1 #if INSTANT_PWM == 1
// InstantPWM // InstantPWM

25
ArduCopter/motors_y6.pde
View File

@ -106,12 +106,25 @@ static void output_motors_armed()
} }
#endif #endif
APM_RC.OutputCh(CH_1, motor_out[CH_1]); // this filter slows the acceleration of motors vs the deceleration
APM_RC.OutputCh(CH_2, motor_out[CH_2]); // Idea by Denny Rowland to help with his Yaw issue
APM_RC.OutputCh(CH_3, motor_out[CH_3]); for(int8_t i = CH_1; i <= CH_8; i++ ) {
APM_RC.OutputCh(CH_4, motor_out[CH_4]); if(i == CH_5 || i == CH_6)
APM_RC.OutputCh(CH_7, motor_out[CH_7]); continue;
APM_RC.OutputCh(CH_8, motor_out[CH_8]); if(motor_filtered[i] < motor_out[i]){
motor_filtered[i] = (motor_out[i] + motor_filtered[i]) / 2;
}else{
// don't filter
motor_filtered[i] = motor_out[i];
}
}
APM_RC.OutputCh(CH_1, motor_filtered[CH_1]);
APM_RC.OutputCh(CH_2, motor_filtered[CH_2]);
APM_RC.OutputCh(CH_3, motor_filtered[CH_3]);
APM_RC.OutputCh(CH_4, motor_filtered[CH_4]);
APM_RC.OutputCh(CH_7, motor_filtered[CH_7]);
APM_RC.OutputCh(CH_8, motor_filtered[CH_8]);
#if INSTANT_PWM == 1 #if INSTANT_PWM == 1
// InstantPWM // InstantPWM