1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-24 00:35:39 +03:00

started merging in generic servo handler

git-svn-id: https://afrodevices.googlecode.com/svn/trunk/baseflight@422 7c89a4a9-59b9-e629-4cfe-3a2d53b20e61
This commit is contained in:
timecop@gmail.com 2013-09-30 23:42:44 +00:00
parent 2272e1a5a6
commit 7c595e4110
4 changed files with 25 additions and 14 deletions

View file

@ -231,6 +231,13 @@ void tailSerialReply(void)
serialize8(checksum);
}
void s_struct(uint8_t *cb, uint8_t siz)
{
headSerialReply(siz);
while (siz--)
serialize8(*cb++);
}
void serializeNames(const char *s)
{
const char *c;
@ -457,6 +464,9 @@ static void evaluateCommand(void)
for (i = 0; i < 8; i++)
serialize16(servo[i]);
break;
case MSP_SERVO_CONF:
s_struct((uint8_t *)&cfg.servoConf, 56); // struct servoConf is 7 bytes length: min:2 / max:2 / middle:2 / rate:1 ---- 8 servo => 8x7 = 56
break;
case MSP_MOTOR:
headSerialReply(16);
for (i = 0; i < 8; i++)