aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_Math: fix LoadUint() to allow 32bit values

Browse Source
This commit is contained in:
Tom Pittenger 2020-10-05 09:02:53 -07:00 committed by Tom Pittenger
parent e4f8d47423
commit 5e2450c4ea
2 changed files with 2 additions and 11 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
libraries/AP_Math/bitwise.cpp
View File

@ -19,17 +19,11 @@
#include "bitwise.h"
void loadUint(uint8_t *b, uint16_t v, uint8_t bitCount, bool MSBfirst)
void loadUint(uint8_t *b, uint32_t v, uint8_t bitCount, bool MSBfirst)
{
const uint8_t last = bitCount/8;
// count = 32
// last = 4
// MSBfirst = 1;
for (uint8_t i=0; i<last; i++) {
const uint8_t idx = MSBfirst ? last-1-i : i;
// idx = 4-1-0
b[i] = v >> (8*idx);
}
}

5
libraries/AP_Math/bitwise.h
View File

@ -19,11 +19,8 @@
#include <stdint.h>
void loadUint(uint8_t *b, uint16_t v, uint8_t bitCount, bool MSBfirst = true);
void loadUint(uint8_t *b, uint32_t v, uint8_t bitCount, bool MSBfirst = true);
//void loadU16(uint8_t *b, uint16_t v, bool MSBfirst = true) { loadUx(b, v, 16, MSBfirst); }
//void loadU24(uint8_t *b, uint32_t v, bool MSBfirst = true) { loadUx(b, v, 24, MSBfirst); }
//void loadU32(uint8_t *b, uint32_t v, bool MSBfirst = true) { loadUx(b, v, 32, MSBfirst); }
uint16_t fetchU16(const uint8_t *v, bool MSBfirst = true);
uint32_t fetchU24(const uint8_t *v, bool MSBfirst = true);
uint32_t fetchU32(const uint8_t *v, bool MSBfirst = true);