mirror of
https://github.com/iNavFlight/inav.git
synced 2025-07-23 00:05:28 +03:00
add msp telemtry
This commit is contained in:
parent
1092fa5b40
commit
b14b058fa0
7 changed files with 90 additions and 2 deletions
|
@ -715,3 +715,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