diff --git a/cpp/hal/gpiobus_raspberry.cpp b/cpp/hal/gpiobus_raspberry.cpp
index 5b6f77f7..66332966 100644
--- a/cpp/hal/gpiobus_raspberry.cpp
+++ b/cpp/hal/gpiobus_raspberry.cpp
@@ -608,42 +608,31 @@ uint8_t GPIOBUS_Raspberry::GetDAT()
     return (uint8_t)data;
 }
 
-//---------------------------------------------------------------------------
-//
-//	Set data signals
-//
-//---------------------------------------------------------------------------
 void GPIOBUS_Raspberry::SetDAT(uint8_t dat)
 {
-    // Write to port
+    // Write to ports
 #if SIGNAL_CONTROL_MODE == 0
     uint32_t fsel = gpfsel[0];
     fsel &= tblDatMsk[0][dat];
     fsel |= tblDatSet[0][dat];
-    if (fsel != gpfsel[0]) {
-        gpfsel[0]         = fsel;
-        gpio[GPIO_FSEL_0] = fsel;
-    }
+    gpfsel[0] = fsel;
+    gpio[GPIO_FSEL_0] = fsel;
 
     fsel = gpfsel[1];
     fsel &= tblDatMsk[1][dat];
     fsel |= tblDatSet[1][dat];
-    if (fsel != gpfsel[1]) {
-        gpfsel[1]         = fsel;
-        gpio[GPIO_FSEL_1] = fsel;
-    }
+    gpfsel[1] = fsel;
+    gpio[GPIO_FSEL_1] = fsel;
 
     fsel = gpfsel[2];
     fsel &= tblDatMsk[2][dat];
     fsel |= tblDatSet[2][dat];
-    if (fsel != gpfsel[2]) {
-        gpfsel[2]         = fsel;
-        gpio[GPIO_FSEL_2] = fsel;
-    }
+    gpfsel[2] = fsel;
+    gpio[GPIO_FSEL_2] = fsel;
 #else
     gpio[GPIO_CLR_0] = tblDatMsk[dat];
     gpio[GPIO_SET_0] = tblDatSet[dat];
-#endif // SIGNAL_CONTROL_MODE
+#endif
 }
 
 bool GPIOBUS_Raspberry::GetDP() const