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

WIP

Browse Source
This commit is contained in:
Daniel Agar
2022-04-20 15:09:31 -04:00
parent 37fa4bccb6
commit 4f9948d1de
1 changed files with 11 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/magnetometer/isentek/ist8310/IST8310.cpp
+11 -6
View File
@@ -1,6 +1,6 @@
/****************************************************************************
*
* Copyright (c) 2020 PX4 Development Team. All rights reserved.
* Copyright (c) 2020-2022 PX4 Development Team. All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
@@ -85,14 +85,19 @@ void IST8310::print_status()
int IST8310::probe()
{
const uint8_t WAI = RegisterRead(Register::WAI);
for (int retry = 0; retry < 3; retry++) {
if (WAI != Device_ID) {
DEVICE_DEBUG("unexpected WAI 0x%02x", WAI);
return PX4_ERROR;
const uint8_t WAI = RegisterRead(Register::WAI);
if (WAI == Device_ID) {
return PX4_OK;
} else {
DEVICE_DEBUG("unexpected WAI 0x%02x", WAI);
}
}
return PX4_OK;
return PX4_ERROR;
}
void IST8310::RunImpl()