1
0
Fork 0
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:
treymarc 2014-04-22 13:48:57 +02:00
parent 1092fa5b40
commit b14b058fa0
7 changed files with 90 additions and 2 deletions

View file

@ -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;
}
}