diff options
author | Simon Wilks <sjwilks@gmail.com> | 2013-06-28 08:42:05 +0200 |
---|---|---|
committer | Simon Wilks <sjwilks@gmail.com> | 2013-06-28 08:42:05 +0200 |
commit | dadd8703b422523d88b02effe48e76152bcb2fce (patch) | |
tree | f203387c3c5aa8a6c88614d6717d68c22c2a6ab7 /src/drivers/hott_telemetry/messages.c | |
parent | 85b5da8078873a13a5fc0fd4ee3fe0a02917e87c (diff) | |
download | px4-firmware-dadd8703b422523d88b02effe48e76152bcb2fce.tar.gz px4-firmware-dadd8703b422523d88b02effe48e76152bcb2fce.tar.bz2 px4-firmware-dadd8703b422523d88b02effe48e76152bcb2fce.zip |
Initial non-tested code for reading from the ESC.
Diffstat (limited to 'src/drivers/hott_telemetry/messages.c')
-rw-r--r-- | src/drivers/hott_telemetry/messages.c | 28 |
1 files changed, 26 insertions, 2 deletions
diff --git a/src/drivers/hott_telemetry/messages.c b/src/drivers/hott_telemetry/messages.c index d2634ef41..149c4d367 100644 --- a/src/drivers/hott_telemetry/messages.c +++ b/src/drivers/hott_telemetry/messages.c @@ -73,6 +73,31 @@ messages_init(void) airspeed_sub = orb_subscribe(ORB_ID(airspeed)); } +void +build_esc_request(uint8_t *buffer, size_t *size) +{ + struct esc_module_poll_msg msg; + *size = sizeof(msg); + memset(&msg, 0, *size); + + msg.mode = BINARY_MODE_REQUEST_ID; + msg.id = ESC_SENSOR_ID; + + memcpy(&msg, buffer, size); +} + +void +extract_esc_message(const uint8_t *buffer) +{ + struct esc_module_msg msg; + size_t size = sizeof(msg); + memset(&msg, 0, size); + memcpy(buffer, &msg, size); + + // Publish it. + +} + void build_eam_response(uint8_t *buffer, size_t *size) { @@ -92,7 +117,7 @@ build_eam_response(uint8_t *buffer, size_t *size) msg.start = START_BYTE; msg.eam_sensor_id = EAM_SENSOR_ID; - msg.sensor_id = EAM_SENSOR_TEXT_ID; + msg.sensor_text_id = EAM_SENSOR_TEXT_ID; msg.temperature1 = (uint8_t)(raw.baro_temp_celcius + 20); msg.temperature2 = msg.temperature1 - BOARD_TEMP_OFFSET_DEG; @@ -111,7 +136,6 @@ build_eam_response(uint8_t *buffer, size_t *size) uint16_t speed = (uint16_t)(airspeed.indicated_airspeed_m_s); msg.speed_L = (uint8_t)speed & 0xff; msg.speed_H = (uint8_t)(speed >> 8) & 0xff; - msg.stop = STOP_BYTE; memcpy(buffer, &msg, *size); |