Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-19 14:25:20 +03:00
Code Issues Wiki Activity

Support pan and tilt on fixed wing. Fixes #1006

Browse source 
The general idea is that nothing calls pwmWriteServo except for
writeServos() and that writeServos() knows which servos it has used.
This commit is contained in:
Dominic Clifton 2015-06-10 14:30:45 +01:00
parent 9a8a31676b
commit 889b14df5f
2 changed files with 44 additions and 44 deletions
Download patch file Download diff file Expand all files Collapse all files

50
src/main/flight/mixer.c
View file

@ -431,21 +431,14 @@ void mixerResetMotors(void)
#ifdef USE_SERVOS
STATIC_UNIT_TESTED void forwardAuxChannelsToServos(void)
STATIC_UNIT_TESTED void forwardAuxChannelsToServos(uint8_t firstServoIndex)
{
// offset servos based off number already used in mixer types
// airplane and servo_tilt together can't be used
int8_t firstServo = servoCount - AUX_FORWARD_CHANNEL_TO_SERVO_COUNT;
// start forwarding from this channel
uint8_t channelOffset = AUX1;
int8_t servoOffset;
uint8_t servoOffset;
for (servoOffset = 0; servoOffset < AUX_FORWARD_CHANNEL_TO_SERVO_COUNT; servoOffset++) {
if (firstServo + servoOffset < 0) {
continue; // there are not enough servos to forward all the AUX channels.
}
pwmWriteServo(firstServo + servoOffset, rcData[channelOffset++]);
pwmWriteServo(firstServoIndex + servoOffset, rcData[channelOffset++]);
}
}
@ -460,48 +453,52 @@ void writeServos(void)
if (!useServo)
return;
uint8_t servoIndex = 0;
switch (currentMixerMode) {
case MIXER_BI:
pwmWriteServo(0, servo[SERVO_BIPLANE_LEFT]);
pwmWriteServo(1, servo[SERVO_BIPLANE_RIGHT]);
pwmWriteServo(servoIndex++, servo[SERVO_BIPLANE_LEFT]);
pwmWriteServo(servoIndex++, servo[SERVO_BIPLANE_RIGHT]);
break;
case MIXER_TRI:
if (mixerConfig->tri_unarmed_servo) {
// if unarmed flag set, we always move servo
pwmWriteServo(0, servo[SERVO_RUDDER]);
pwmWriteServo(servoIndex++, servo[SERVO_RUDDER]);
} else {
// otherwise, only move servo when copter is armed
if (ARMING_FLAG(ARMED))
pwmWriteServo(0, servo[SERVO_RUDDER]);
pwmWriteServo(servoIndex++, servo[SERVO_RUDDER]);
else
pwmWriteServo(0, 0); // kill servo signal completely.
pwmWriteServo(servoIndex++, 0); // kill servo signal completely.
}
break;
case MIXER_FLYING_WING:
pwmWriteServo(0, servo[SERVO_FLAPPERON_1]);
pwmWriteServo(1, servo[SERVO_FLAPPERON_2]);
pwmWriteServo(servoIndex++, servo[SERVO_FLAPPERON_1]);
pwmWriteServo(servoIndex++, servo[SERVO_FLAPPERON_2]);
break;
case MIXER_GIMBAL:
updateGimbalServos();
servoIndex += 2;
break;
case MIXER_DUALCOPTER:
pwmWriteServo(0, servo[SERVO_DUALCOPTER_LEFT]);
pwmWriteServo(1, servo[SERVO_DUALCOPTER_RIGHT]);
pwmWriteServo(servoIndex++, servo[SERVO_DUALCOPTER_LEFT]);
pwmWriteServo(servoIndex++, servo[SERVO_DUALCOPTER_RIGHT]);
break;
case MIXER_AIRPLANE:
for (int i = SERVO_PLANE_INDEX_MIN; i <= SERVO_PLANE_INDEX_MAX; i++) {
pwmWriteServo(i - SERVO_PLANE_INDEX_MIN, servo[i]);
pwmWriteServo(servoIndex++, servo[i]);
}
break;
case MIXER_SINGLECOPTER:
for (int i = SERVO_SINGLECOPTER_INDEX_MIN; i <= SERVO_SINGLECOPTER_INDEX_MAX; i++) {
pwmWriteServo(i - SERVO_SINGLECOPTER_INDEX_MIN, servo[i]);
pwmWriteServo(servoIndex++, servo[i]);
}
break;
@ -509,9 +506,16 @@ void writeServos(void)
// Two servos for SERVO_TILT, if enabled
if (feature(FEATURE_SERVO_TILT)) {
updateGimbalServos();
servoIndex += 2;
}
break;
}
// forward AUX1-4 to servo outputs (not constrained)
if (gimbalConfig->gimbal_flags & GIMBAL_FORWARDAUX) {
forwardAuxChannelsToServos(servoIndex);
servoIndex += AUX_FORWARD_CHANNEL_TO_SERVO_COUNT;
}
}
#endif
@ -710,10 +714,6 @@ void mixTable(void)
servo[i] = constrain(servo[i], servoConf[i].min, servoConf[i].max); // limit the values
}
}
// forward AUX1-4 to servo outputs (not constrained)
if (gimbalConfig->gimbal_flags & GIMBAL_FORWARDAUX) {
forwardAuxChannelsToServos();
}
#endif
if (ARMING_FLAG(ARMED)) {