Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-22 08:38:36 -04:00
Code Issues Packages Projects Releases Wiki Activity

Copter: remove unused servo_write function

Browse Source
This commit is contained in:
Randy Mackay 2014-05-09 13:31:08 +09:00
parent 1e8b99ad17
commit b4dcad725c
1 changed files with 0 additions and 31 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

31
ArduCopter/motors.pde
View File

@ -567,34 +567,3 @@ set_servos_4()
motors.output();
}
}
// servo_write - writes to a servo after checking the channel is not used for a motor
static void servo_write(uint8_t ch, uint16_t pwm)
{
bool servo_ok = false;
#if (FRAME_CONFIG == QUAD_FRAME || FRAME_CONFIG == COAX_FRAME)
// Quads can use RC5 and higher as servos
if (ch >= CH_5) servo_ok = true;
#elif (FRAME_CONFIG == TRI_FRAME || FRAME_CONFIG == SINGLE_FRAME)
// Tri's and Singles can use RC5, RC6, RC8 and higher
if (ch == CH_5 || ch == CH_6 || ch >= CH_8) servo_ok = true;
#elif (FRAME_CONFIG == HEXA_FRAME || FRAME_CONFIG == Y6_FRAME)
// Hexa and Y6 can use RC7 and higher
if (ch >= CH_7) servo_ok = true;
#elif (FRAME_CONFIG == OCTA_FRAME || FRAME_CONFIG == OCTA_QUAD_FRAME)
// Octa and X8 can use RC9 and higher
if (ch >= CH_9) servo_ok = true;
#elif (FRAME_CONFIG == HELI_FRAME)
// Heli's can use RC5, RC6, RC7, not RC8, and higher
if (ch == CH_5 || ch == CH_6 || ch == CH_7 || ch >= CH_9) servo_ok = true;
#else
// throw compile error if frame type is unrecognise
#error Unrecognised frame type
#endif
if (servo_ok) {
hal.rcout->enable_ch(ch);
hal.rcout->write(ch, pwm);
}
}