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

Sonar altitude added to sensors

This commit is contained in:
Krzysztof Rosinski 2015-01-28 22:24:44 +01:00
parent 862e96f2aa
commit f933dbf330
3 changed files with 71 additions and 1 deletions

View file

@ -42,6 +42,7 @@ var MSP_codes = {
MSP_WP: 118,
MSP_BOXIDS: 119,
MSP_SERVO_CONF: 120,
MSP_SONAR: 123,
MSP_SET_RAW_RC: 200,
MSP_SET_RAW_GPS: 201,
@ -260,6 +261,9 @@ var MSP = {
case MSP_codes.MSP_ALTITUDE:
SENSOR_DATA.altitude = parseFloat((data.getInt32(0, 1) / 100.0).toFixed(2)); // correct scale factor
break;
case MSP_codes.MSP_SONAR:
SENSOR_DATA.sonar = data.getInt32(0, 1);
break;
case MSP_codes.MSP_ANALOG:
ANALOG.voltage = data.getUint8(0) / 10.0;
ANALOG.mAhdrawn = data.getUint16(1, 1);