adafruit-mirror/Adafruit_Wippersnapper_Arduino
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity

fix(as5600): correct fail logic in configureSensor()

Browse source
This commit is contained in:
tyeth 2025-08-21 16:24:14 +01:00
parent dda19cd00a
commit fc71187a3f
1 changed files with 9 additions and 13 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

22
src/components/i2c/drivers/WipperSnapper_I2C_Driver_AS5600.h
View file

@ -78,23 +78,19 @@ class WipperSnapper_I2C_Driver_AS5600 : public WipperSnapper_I2C_Driver {
*/
/*******************************************************************************/
bool configureSensor() {
return _as5600->enableWatchdog(false) || // Normal (high) power mode
_as5600->setPowerMode(AS5600_POWER_MODE_NOM) ||
return _as5600->enableWatchdog(false) &&
// Normal (high) power mode
_as5600->setPowerMode(AS5600_POWER_MODE_NOM) &&
// No Hysteresis
_as5600->setHysteresis(AS5600_HYSTERESIS_OFF) ||
_as5600->setHysteresis(AS5600_HYSTERESIS_OFF) &&
// analog output (0-VCC for 0-360 degrees)
_as5600->setOutputStage(AS5600_OUTPUT_STAGE_ANALOG_FULL) ||
_as5600->setOutputStage(AS5600_OUTPUT_STAGE_ANALOG_FULL) &&
// setup filters
_as5600->setSlowFilter(AS5600_SLOW_FILTER_16X) ||
_as5600->setFastFilterThresh(AS5600_FAST_FILTER_THRESH_SLOW_ONLY) ||
_as5600->setSlowFilter(AS5600_SLOW_FILTER_16X) &&
_as5600->setFastFilterThresh(AS5600_FAST_FILTER_THRESH_SLOW_ONLY) &&
// Reset position settings to defaults
_as5600->setZPosition(0) || _as5600->setMPosition(4095) ||
_as5600->setZPosition(0) && _as5600->setMPosition(4095) &&
_as5600->setMaxAngle(4095);
return true;
}
bool readSensor() {
@ -107,7 +103,7 @@ class WipperSnapper_I2C_Driver_AS5600 : public WipperSnapper_I2C_Driver {
uint16_t rawAngle = _as5600->getRawAngle();
uint16_t angle = _as5600->getAngle();
WS_DEBUG_PRINT("Raw: ");
WS_DEBUG_PRINT("AS5600 Raw: ");
WS_DEBUG_PRINT(rawAngle);
WS_DEBUG_PRINT(" (0x");
WS_DEBUG_PRINT(rawAngle, HEX);