Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-13 03:20:00 +03:00
Code Issues Wiki Activity

lis2mdl: fix read (#14227)

Browse source 
* lis2mdl: revert reading status register, use measure/collect paradigm

* Update src/main/drivers/compass/compass_lis2mdl.c

Co-authored-by: Mark Haslinghuis <mark@numloq.nl>

* fix typo

* fixed borked logic

---------

Co-authored-by: Mark Haslinghuis <mark@numloq.nl>
This commit is contained in:
Jacob Dahl 2025-02-04 10:00:11 -09:00 • committed by GitHub
parent f2e9dac322
commit 896bf03b4e
No known key found for this signature in database
GPG key ID: B5690EEEBB952194
1 changed files with 8 additions and 11 deletions
Download patch file Download diff file Expand all files Collapse all files

17
src/main/drivers/compass/compass_lis2mdl.c
View file

@ -77,20 +77,15 @@ static bool lis2mdlInit(magDev_t *mag)
static bool lis2mdlRead(magDev_t *mag, int16_t *magData)
{
uint8_t status = 0;
uint8_t buf[6];
static uint8_t buf[6];
static bool pendingRead = true;
extDevice_t *dev = &mag->dev;
if (!busReadRegisterBuffer(dev, LIS2MDL_ADDR_STATUS_REG, &status, sizeof(status))) {
return false;
if (pendingRead) {
if (busReadRegisterBufferStart(dev, LIS2MDL_ADDR_OUTX_L_REG, (uint8_t *)buf, sizeof(buf))) {
pendingRead = false;
}
if (!(status & LIS2MDL_STATUS_REG_READY)) {
return false;
}
if (!busReadRegisterBuffer(dev, LIS2MDL_ADDR_OUTX_L_REG, (uint8_t *)&buf, sizeof(buf))) {
return false;
}
@ -107,6 +102,8 @@ static bool lis2mdlRead(magDev_t *mag, int16_t *magData)
magData[Y] = y;
magData[Z] = z;
pendingRead = true;
return true;
}