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

4
Tools/AP_Periph/hwing_esc.h

@ -44,8 +44,8 @@ private: @@ -44,8 +44,8 @@ private:
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;

Loading…
Cancel
Save