|
自己加个V6的电机配置。
}else if( _frame_orientation == AP_MOTORS_V_FRAME ) {
// V frame set-up
add_motor_raw(AP_MOTORS_MOT_1, -0.7623, 0, AP_MOTORS_MATRIX_MOTOR_CW, AP_MOTORS_MOT_2, 2);
add_motor_raw(AP_MOTORS_MOT_2, 0.7623, 0, AP_MOTORS_MATRIX_MOTOR_CCW, AP_MOTORS_MOT_1, 5);
add_motor_raw(AP_MOTORS_MOT_3, 1, 0.9533, AP_MOTORS_MATRIX_MOTOR_CW, AP_MOTORS_MOT_4, 6);
add_motor_raw(AP_MOTORS_MOT_4, -0.5246, -0.9533, AP_MOTORS_MATRIX_MOTOR_CCW, AP_MOTORS_MOT_3, 3);
add_motor_raw(AP_MOTORS_MOT_5, -1, 0.9533, AP_MOTORS_MATRIX_MOTOR_CCW, AP_MOTORS_MOT_6, 1);
add_motor_raw(AP_MOTORS_MOT_6, 0.5246, -0.9533, AP_MOTORS_MATRIX_MOTOR_CW, AP_MOTORS_MOT_5, 4);
}
==========================================================================
然后在APM_Config.h中定义
#define FRAME_CONFIG HEXA_FRAME
/*
options:
QUAD_FRAME
TRI_FRAME
HEXA_FRAME
Y6_FRAME
OCTA_FRAME
OCTA_QUAD_FRAME
HELI_FRAME
*/
#define FRAME_ORIENTATION V_FRAME
/*
PLUS_FRAME
X_FRAME
V_FRAME
*/
搞定。
[ 本帖最后由 feitian227 于 2012-6-18 09:23 编辑 ] |
|