Browse Source

AP_Periph: fixed current decoding for HWESC

c415-sdk
Andrew Tridgell 5 years ago
parent
commit
5462c468cd
  1. 4
      Tools/AP_Periph/hwing_esc.cpp
  2. 4
      Tools/AP_Periph/hwing_esc.h

4
Tools/AP_Periph/hwing_esc.cpp

@ -105,8 +105,8 @@ bool HWESC_Telem::parse_packet(void)
decoded.throttle = be16toh(pkt.throttle); decoded.throttle = be16toh(pkt.throttle);
decoded.rpm = be16toh(pkt.rpm); decoded.rpm = be16toh(pkt.rpm);
decoded.voltage = be16toh(pkt.voltage) * 0.1; decoded.voltage = be16toh(pkt.voltage) * 0.1;
decoded.load = be16toh(pkt.load); decoded.load = int16_t(be16toh(pkt.load));
decoded.current = be16toh(pkt.current); decoded.current = int16_t(be16toh(pkt.current)) * 0.01;
decoded.temperature = be16toh(pkt.temperature); decoded.temperature = be16toh(pkt.temperature);
decoded.unknown = be16toh(pkt.unknown); decoded.unknown = be16toh(pkt.unknown);

4
Tools/AP_Periph/hwing_esc.h

@ -44,8 +44,8 @@ private:
uint16_t throttle; uint16_t throttle;
uint16_t rpm; uint16_t rpm;
uint16_t voltage; uint16_t voltage;
uint16_t load; int16_t current;
uint16_t current; int16_t load;
uint16_t temperature; uint16_t temperature;
uint16_t unknown; uint16_t unknown;
uint16_t crc; uint16_t crc;

Loading…
Cancel
Save