fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-07-22 01:30:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

ina228: fix sign error on CURRENT reading (#19296)

Browse Source
This commit is contained in:
Jacob Dahl
2022-03-08 15:47:11 -09:00
committed by GitHub
parent b7e0f17c6a
commit 3e21efb721
1 changed files with 6 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/power_monitor/ina228/ina228.cpp
+6 -1
View File
@@ -124,7 +124,12 @@ int INA228::read(uint8_t address, int32_t &data)
const int ret = transfer(&address, 1, (uint8_t *)&received_bytes, sizeof(received_bytes) - 1); const int ret = transfer(&address, 1, (uint8_t *)&received_bytes, sizeof(received_bytes) - 1);
if (ret == PX4_OK) { if (ret == PX4_OK) {
data = swap32(received_bytes) >> ((32 - 24) + 4); data = swap32(received_bytes) >> ((32 - 24) + 4); // Convert to 20bit value
// Handle negative 20bit twos complement
if (data & 0x80000) {
data = -((0x000FFFFF & ~data) + 1);
}
} else { } else {
perf_count(_comms_errors); perf_count(_comms_errors);