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:
parent
2272e1a5a6
commit
7c595e4110
4 changed files with 25 additions and 14 deletions
10
src/serial.c
10
src/serial.c
|
@ -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++)
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue