Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-09 01:13:57 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_MotorsHeli: Rename tradheli servo objects for clarity

Browse Source
This commit is contained in:
Robert Lefebvre 2015-08-07 18:42:21 -04:00 committed by Randy Mackay
parent 6a7996d367
commit ec400e06d8
2 changed files with 31 additions and 31 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

46
libraries/AP_Motors/AP_MotorsHeli_Single.cpp
View File

@ -291,19 +291,19 @@ void AP_MotorsHeli_Single::output_disarmed()
// reset_servos // reset_servos
void AP_MotorsHeli_Single::reset_servos() void AP_MotorsHeli_Single::reset_servos()
{ {
reset_swash_servo (_servo_1); reset_swash_servo (_swash_servo_1);
reset_swash_servo (_servo_2); reset_swash_servo (_swash_servo_2);
reset_swash_servo (_servo_3); reset_swash_servo (_swash_servo_3);
} }
// init_servos // init_servos
void AP_MotorsHeli_Single::init_servos() void AP_MotorsHeli_Single::init_servos()
{ {
init_swash_servo (_servo_1); init_swash_servo (_swash_servo_1);
init_swash_servo (_servo_2); init_swash_servo (_swash_servo_2);
init_swash_servo (_servo_3); init_swash_servo (_swash_servo_3);
_servo_4.set_angle(4500); _yaw_servo.set_angle(4500);
} }
// calculate_roll_pitch_collective_factors - calculate factors based on swash type and servo position // calculate_roll_pitch_collective_factors - calculate factors based on swash type and servo position
@ -444,23 +444,23 @@ void AP_MotorsHeli_Single::move_swash(int16_t roll_out, int16_t pitch_out, int16
} }
// swashplate servos // swashplate servos
_servo_1.servo_out = (_rollFactor[CH_1] * roll_out + _pitchFactor[CH_1] * pitch_out)/10 + _collectiveFactor[CH_1] * coll_out_scaled + (_servo_1.radio_trim-1500); _swash_servo_1.servo_out = (_rollFactor[CH_1] * roll_out + _pitchFactor[CH_1] * pitch_out)/10 + _collectiveFactor[CH_1] * coll_out_scaled + (_swash_servo_1.radio_trim-1500);
_servo_2.servo_out = (_rollFactor[CH_2] * roll_out + _pitchFactor[CH_2] * pitch_out)/10 + _collectiveFactor[CH_2] * coll_out_scaled + (_servo_2.radio_trim-1500); _swash_servo_2.servo_out = (_rollFactor[CH_2] * roll_out + _pitchFactor[CH_2] * pitch_out)/10 + _collectiveFactor[CH_2] * coll_out_scaled + (_swash_servo_2.radio_trim-1500);
if (_swash_type == AP_MOTORS_HELI_SINGLE_SWASH_H1) { if (_swash_type == AP_MOTORS_HELI_SINGLE_SWASH_H1) {
_servo_1.servo_out += 500; _swash_servo_1.servo_out += 500;
_servo_2.servo_out += 500; _swash_servo_2.servo_out += 500;
} }
_servo_3.servo_out = (_rollFactor[CH_3] * roll_out + _pitchFactor[CH_3] * pitch_out)/10 + _collectiveFactor[CH_3] * coll_out_scaled + (_servo_3.radio_trim-1500); _swash_servo_3.servo_out = (_rollFactor[CH_3] * roll_out + _pitchFactor[CH_3] * pitch_out)/10 + _collectiveFactor[CH_3] * coll_out_scaled + (_swash_servo_3.radio_trim-1500);
// use servo_out to calculate pwm_out and radio_out // use servo_out to calculate pwm_out and radio_out
_servo_1.calc_pwm(); _swash_servo_1.calc_pwm();
_servo_2.calc_pwm(); _swash_servo_2.calc_pwm();
_servo_3.calc_pwm(); _swash_servo_3.calc_pwm();
// actually move the servos // actually move the servos
hal.rcout->write(pgm_read_byte(&_motor_to_channel_map[AP_MOTORS_MOT_1]), _servo_1.radio_out); hal.rcout->write(pgm_read_byte(&_motor_to_channel_map[AP_MOTORS_MOT_1]), _swash_servo_1.radio_out);
hal.rcout->write(pgm_read_byte(&_motor_to_channel_map[AP_MOTORS_MOT_2]), _servo_2.radio_out); hal.rcout->write(pgm_read_byte(&_motor_to_channel_map[AP_MOTORS_MOT_2]), _swash_servo_2.radio_out);
hal.rcout->write(pgm_read_byte(&_motor_to_channel_map[AP_MOTORS_MOT_3]), _servo_3.radio_out); hal.rcout->write(pgm_read_byte(&_motor_to_channel_map[AP_MOTORS_MOT_3]), _swash_servo_3.radio_out);
// update the yaw rate using the tail rotor/servo // update the yaw rate using the tail rotor/servo
move_yaw(yaw_out + yaw_offset); move_yaw(yaw_out + yaw_offset);
@ -469,22 +469,22 @@ void AP_MotorsHeli_Single::move_swash(int16_t roll_out, int16_t pitch_out, int16
// move_yaw // move_yaw
void AP_MotorsHeli_Single::move_yaw(int16_t yaw_out) void AP_MotorsHeli_Single::move_yaw(int16_t yaw_out)
{ {
_servo_4.servo_out = constrain_int16(yaw_out, -4500, 4500); _yaw_servo.servo_out = constrain_int16(yaw_out, -4500, 4500);
if (_servo_4.servo_out != yaw_out) { if (_yaw_servo.servo_out != yaw_out) {
limit.yaw = true; limit.yaw = true;
} }
_servo_4.calc_pwm(); _yaw_servo.calc_pwm();
hal.rcout->write(pgm_read_byte(&_motor_to_channel_map[AP_MOTORS_MOT_4]), _servo_4.radio_out); hal.rcout->write(pgm_read_byte(&_motor_to_channel_map[AP_MOTORS_MOT_4]), _yaw_servo.radio_out);
if (_tail_type == AP_MOTORS_HELI_SINGLE_TAILTYPE_SERVO_EXTGYRO) { if (_tail_type == AP_MOTORS_HELI_SINGLE_TAILTYPE_SERVO_EXTGYRO) {
// output gain to exernal gyro // output gain to exernal gyro
write_aux(_ext_gyro_gain); write_aux(_ext_gyro_gain);
} else if (_tail_type == AP_MOTORS_HELI_SINGLE_TAILTYPE_DIRECTDRIVE_FIXEDPITCH && _main_rotor.get_desired_speed() > 0) { } else if (_tail_type == AP_MOTORS_HELI_SINGLE_TAILTYPE_DIRECTDRIVE_FIXEDPITCH && _main_rotor.get_desired_speed() > 0) {
// output yaw servo to tail rsc // output yaw servo to tail rsc
write_aux(_servo_4.servo_out); write_aux(_yaw_servo.servo_out);
} }
} }

16
libraries/AP_Motors/AP_MotorsHeli_Single.h
View File

@ -56,10 +56,10 @@ public:
uint16_t speed_hz = AP_MOTORS_HELI_SPEED_DEFAULT) : uint16_t speed_hz = AP_MOTORS_HELI_SPEED_DEFAULT) :
AP_MotorsHeli(loop_rate, speed_hz), AP_MotorsHeli(loop_rate, speed_hz),
_servo_aux(servo_aux), _servo_aux(servo_aux),
_servo_1(servo_1), _swash_servo_1(servo_1),
_servo_2(servo_2), _swash_servo_2(servo_2),
_servo_3(servo_3), _swash_servo_3(servo_3),
_servo_4(servo_4), _yaw_servo(servo_4),
_main_rotor(servo_rsc, AP_MOTORS_HELI_SINGLE_RSC, loop_rate), _main_rotor(servo_rsc, AP_MOTORS_HELI_SINGLE_RSC, loop_rate),
_tail_rotor(servo_aux, AP_MOTORS_HELI_SINGLE_AUX, loop_rate) _tail_rotor(servo_aux, AP_MOTORS_HELI_SINGLE_AUX, loop_rate)
{ {
@ -148,10 +148,10 @@ protected:
// external objects we depend upon // external objects we depend upon
RC_Channel& _servo_aux; // output to ext gyro gain and tail direct drive esc (ch7) RC_Channel& _servo_aux; // output to ext gyro gain and tail direct drive esc (ch7)
RC_Channel& _servo_1; // swash plate servo #1 RC_Channel& _swash_servo_1; // swash plate servo #1
RC_Channel& _servo_2; // swash plate servo #2 RC_Channel& _swash_servo_2; // swash plate servo #2
RC_Channel& _servo_3; // swash plate servo #3 RC_Channel& _swash_servo_3; // swash plate servo #3
RC_Channel& _servo_4; // tail servo RC_Channel& _yaw_servo; // tail servo
AP_MotorsHeli_RSC _main_rotor; // main rotor AP_MotorsHeli_RSC _main_rotor; // main rotor
AP_MotorsHeli_RSC _tail_rotor; // tail rotor AP_MotorsHeli_RSC _tail_rotor; // tail rotor