diff --git a/variants/elsomik/pins_arduino.h b/variants/elsomik/pins_arduino.h
index 4382db1..3ff5a8f 100644
--- a/variants/elsomik/pins_arduino.h
+++ b/variants/elsomik/pins_arduino.h
@@ -97,7 +97,10 @@ GPIO_TypeDef* digitalPinToPort(uint32_t digPinNumber);
 // determines the pin address inside the port by the board pin number
 static inline HAL_PinsTypeDef digitalPinToBitMask(uint32_t digitalPinNumber)
 {
-  return (HAL_PinsTypeDef)(1 << (digitalPinNumber & 0xF));
+  if (digitalPinNumber >= P2_6)
+    return (HAL_PinsTypeDef)(1 << ((digitalPinNumber+6) & 0xF));
+  else
+    return (HAL_PinsTypeDef)(1 << (digitalPinNumber & 0xF));
 }
 // total number of pins available for initialization
 static inline uint16_t pinCommonQty(void)