mirror of
https://github.com/betaflight/betaflight.git
synced 2025-07-20 14:55:21 +03:00
Merge branch 'master-cleanflight-msptelemetry' of github.com:treymarc/baseflight into treymarc-master-cleanflight-msptelemetry
Conflicts: src/serial_msp.h src/telemetry_common.h
This commit is contained in:
commit
e5c5339306
7 changed files with 106 additions and 2 deletions
|
@ -801,3 +801,54 @@ void mspProcess(void)
|
|||
}
|
||||
}
|
||||
}
|
||||
|
||||
void sendMspTelemetry(void)
|
||||
{
|
||||
static int state = -1;
|
||||
|
||||
switch (state) {
|
||||
default:
|
||||
cmdMSP = MSP_BOXNAMES;
|
||||
evaluateCommand();
|
||||
case 0:
|
||||
cmdMSP = MSP_STATUS;
|
||||
evaluateCommand();
|
||||
cmdMSP = MSP_IDENT;
|
||||
evaluateCommand();
|
||||
state++;
|
||||
break;
|
||||
case 1:
|
||||
cmdMSP = MSP_RAW_IMU;
|
||||
evaluateCommand();
|
||||
state++;
|
||||
break;
|
||||
case 2:
|
||||
cmdMSP = MSP_DEBUG;
|
||||
evaluateCommand();
|
||||
cmdMSP = MSP_ALTITUDE;
|
||||
evaluateCommand();
|
||||
state++;
|
||||
break;
|
||||
case 3:
|
||||
cmdMSP = MSP_RAW_GPS;
|
||||
evaluateCommand();
|
||||
cmdMSP = MSP_RC;
|
||||
evaluateCommand();
|
||||
state++;
|
||||
break;
|
||||
case 4:
|
||||
cmdMSP = MSP_MOTOR_PINS;
|
||||
evaluateCommand();
|
||||
cmdMSP = MSP_ATTITUDE;
|
||||
evaluateCommand();
|
||||
state++;
|
||||
break;
|
||||
case 5:
|
||||
cmdMSP = MSP_SERVO;
|
||||
evaluateCommand();
|
||||
state=0;
|
||||
break;
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue