Subscribe before reading position (#7)

aklajnert · Feb 24, 2021 · 262a2b9 · 262a2b9
1 parent 4f84943
commit 262a2b9
Showing 1 changed file with 6 additions and 0 deletions.
diff --git a/src/lib.rs b/src/lib.rs
@@ -71,6 +71,9 @@ pub enum Error {
     #[fail(display = "Desired position has to be between MIN_HEIGHT and MAX_HEIGHT.")]
     PositionNotInRange,
 
+    #[fail(display = "Cannot subscribe to read position.")]
+    CannotSubscribePosition,
+
     #[fail(display = "Cannot read position.")]
     CannotReadPosition,
 
@@ -176,6 +179,9 @@ impl<T: Device> Idasen<T> {
             return Err(Error::CharacteristicsNotFound("Position".to_string()));
         }
         let position_characteristic = position_characteristic.unwrap().clone();
+        if desk.subscribe(&position_characteristic).is_err() {
+            return Err(Error::CannotSubscribePosition)
+        };
 
         Ok(Self {
             desk,