Modified GpioPin to offer PinState reading

include/sta/gpio_pin.hpp

@@ -37,6 +37,13 @@ namespace sta
          * @param state     Output state
          */
         virtual void setState(GpioPinState state) = 0;
+
+        /**
+         * @brief Get pin input state.
+         *
+         * @param state     Input state
+         */
+        virtual GpioPinState getState() = 0;
     };
 
 

include/sta/raspi/gpio_pin.hpp

@@ -31,6 +31,8 @@ namespace sta
 
         void setState(GpioPinState state) override;
 
+        GpioPinState getState() override;
+
         static RaspiGpioPin * DUMMY_GPIO;
         
     private:

src/raspi/gpio_pin.cpp

@@ -6,7 +6,7 @@
 
 namespace sta 
 {
-    RaspiGpioPin::RaspiGpioPin(uint8_t pin, GpioMode mode) : pin_{pin}, mode_{mode} 
+    RaspiGpioPin::RaspiGpioPin(uint8_t pin, GpioMode mode) : pin_{ pin }, mode_{ mode } 
     {
         pinMode(pin, mode == GpioMode::GPIO_INPUT ? INPUT : OUTPUT);
     }
@@ -16,11 +16,22 @@ namespace sta
         digitalWrite(pin_, state == GpioPinState::GPIO_LOW ? LOW : HIGH);
     }
 
-    class DummyGpioPin : public RaspiGpioPin {
+    GpioPinState RaspiGpioPin::getState()
+    {
+        return digitalRead(pin_) == LOW ? GpioPinState::GPIO_LOW : GpioPinState::GPIO_HIGH;
+    }
+
+    class DummyGpioPin : public RaspiGpioPin 
+    {
     public:
         DummyGpioPin() : RaspiGpioPin { 0, GpioMode::GPIO_INPUT } {}
 
         void setState(GpioPinState state) override {}
+
+        GpioPinState getState() override {
+            // This should really never be called since the code might rely on the returned value to be accurate.
+            STA_UNREACHABLE(); 
+        }
     };
 
     static DummyGpioPin dummyGpio;

src/raspi/spi.cpp

@@ -133,7 +133,7 @@ namespace sta
 
         if (result == -1) {
             printf("Sending failed with error '%s'! \n", strerror(errno));
-        }
+        } 
 
         STA_DEBUG_IOCTL_SEND(result);
     }