From 4f9948d1dec3793c3682e488911b40db3c4c0280 Mon Sep 17 00:00:00 2001 From: Daniel Agar Date: Wed, 20 Apr 2022 14:56:12 -0400 Subject: [PATCH] WIP --- .../magnetometer/isentek/ist8310/IST8310.cpp | 17 +++++++++++------ 1 file changed, 11 insertions(+), 6 deletions(-) diff --git a/src/drivers/magnetometer/isentek/ist8310/IST8310.cpp b/src/drivers/magnetometer/isentek/ist8310/IST8310.cpp index b7d8512ce9..c329542666 100644 --- a/src/drivers/magnetometer/isentek/ist8310/IST8310.cpp +++ b/src/drivers/magnetometer/isentek/ist8310/IST8310.cpp @@ -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()