add set

src/fake_motor.rs

@@ -220,6 +220,9 @@ impl<const N: usize> RawMotorsIO<N> for FakeMotorsIO<N> {
     fn get_board_state(&mut self) -> Result<u8> {
         Ok(0)
     }
+    fn set_board_state(&mut self, _state: u8) -> Result<()> {
+        Ok(())
+    }
 }
 
 #[cfg(test)]

src/motors_controller.rs

@@ -244,6 +244,10 @@ pub trait MotorsController<const N: usize> {
     fn get_board_state(&mut self) -> Result<u8> {
         self.io().get_board_state()
     }
+    /// Set the current state of the articulation control board (clear error)
+    fn set_board_state(&mut self, state: u8) -> Result<()> {
+        self.io().set_board_state(state)
+    }
 }
 
 #[derive(Debug)]

src/motors_io.rs

@@ -41,4 +41,7 @@ pub trait RawMotorsIO<const N: usize> {
 
     /// Get the Board State byte
     fn get_board_state(&mut self) -> Result<u8>;
+
+    /// Set the Board State byte
+    fn set_board_state(&mut self, state: u8) -> Result<()>;
 }