diff --git a/sw/airborne/humid_sht.c b/sw/airborne/humid_sht.c
index 42edee1402..9a5ab9f99f 100644
--- a/sw/airborne/humid_sht.c
+++ b/sw/airborne/humid_sht.c
@@ -231,22 +231,18 @@ uint8_t humid_sht_reset( void )
 void humid_sht_init( void )
 {
   /* Configure DAT/SCL pin as GPIO */
-#if 0  
-  PINSEL0 &= ~(_BV(DAT_PIN*2)|_BV(DAT_PIN*2+1)|
-               _BV(SCK_PIN*2)|_BV(SCK_PIN*2+1));
+
+#if (DAT_PIN<16)
+    PINSEL0 &= ~(_BV(DAT_PIN*2)|_BV(DAT_PIN*2+1));
+#else  
+    PINSEL1 &= ~(_BV((DAT_PIN-16)*2)|_BV((DAT_PIN-16)*2+1));
 #endif
 
-//#if (DAT_PIN<16)
-    PINSEL0 &= ~(_BV(DAT_PIN*2)|_BV(DAT_PIN*2+1));
-//#else  
-//    PINSEL1 &= ~(_BV((DAT_PIN-16)*2)|_BV((DAT_PIN-16)*2+1));
-//#endif
-
-//#if (SCK_PIN<16)
+#if (SCK_PIN<16)
     PINSEL0 &= ~(_BV(SCK_PIN*2)|_BV(SCK_PIN*2+1));
-//#else  
-//    PINSEL1 &= ~(_BV((SCK_PIN-16)*2)|_BV((SCK_PIN-16)*2+1));
-//#endif  
+#else  
+    PINSEL1 &= ~(_BV((SCK_PIN-16)*2)|_BV((SCK_PIN-16)*2+1));
+#endif  
 
   IO0DIR &= ~(_BV(DAT_PIN)); 
   IO0CLR = _BV(DAT_PIN);