From 5462c468cd17d8499d320767c835f43e063d4712 Mon Sep 17 00:00:00 2001 From: Andrew Tridgell Date: Fri, 14 Feb 2020 18:52:07 +1100 Subject: [PATCH] AP_Periph: fixed current decoding for HWESC --- Tools/AP_Periph/hwing_esc.cpp | 4 ++-- Tools/AP_Periph/hwing_esc.h | 4 ++-- 2 files changed, 4 insertions(+), 4 deletions(-) diff --git a/Tools/AP_Periph/hwing_esc.cpp b/Tools/AP_Periph/hwing_esc.cpp index dd128f4c394ff..4fdaa9c48c3e2 100644 --- a/Tools/AP_Periph/hwing_esc.cpp +++ b/Tools/AP_Periph/hwing_esc.cpp @@ -105,8 +105,8 @@ bool HWESC_Telem::parse_packet(void) decoded.throttle = be16toh(pkt.throttle); decoded.rpm = be16toh(pkt.rpm); decoded.voltage = be16toh(pkt.voltage) * 0.1; - decoded.load = be16toh(pkt.load); - decoded.current = be16toh(pkt.current); + decoded.load = int16_t(be16toh(pkt.load)); + decoded.current = int16_t(be16toh(pkt.current)) * 0.01; decoded.temperature = be16toh(pkt.temperature); decoded.unknown = be16toh(pkt.unknown); diff --git a/Tools/AP_Periph/hwing_esc.h b/Tools/AP_Periph/hwing_esc.h index 836ac31dc6a04..36928501b91b1 100644 --- a/Tools/AP_Periph/hwing_esc.h +++ b/Tools/AP_Periph/hwing_esc.h @@ -44,8 +44,8 @@ class HWESC_Telem { uint16_t throttle; uint16_t rpm; uint16_t voltage; - uint16_t load; - uint16_t current; + int16_t current; + int16_t load; uint16_t temperature; uint16_t unknown; uint16_t crc;