diff --git a/ArduinoI2C/ArduinoI2C.ino b/ArduinoI2C/ArduinoI2C.ino index e5b852ea..b443642c 100644 --- a/ArduinoI2C/ArduinoI2C.ino +++ b/ArduinoI2C/ArduinoI2C.ino @@ -34,6 +34,16 @@ int set_and_save_configuration(uint8_t odrive_num, uint8_t axis_num) { if (!success) return __LINE__; + // select hall effect mode + bool user_config_loaded = false; + success = odrive::read_property(odrive_num, &user_config_loaded); + if (!success) + return __LINE__; + if (user_config_loaded) { + Serial.println("ODrive already configured"); + return 0; + } + // select hall effect mode success = odrive::write_axis_property(odrive_num, axis_num, 1); if (!success) @@ -108,6 +118,7 @@ bool do_setup = true; void setup() { Wire.begin(); // join i2c bus (address optional for master) Serial.begin(9600); + Serial.println("Hello World!"); if (do_setup) { Serial.println("Starting ODrive setup...");