diff --git a/arch/arm/plat-rk/include/plat/iomux.h b/arch/arm/plat-rk/include/plat/iomux.h
index 70d8d18380e5..c2c5fc5f3e4d 100644
--- a/arch/arm/plat-rk/include/plat/iomux.h
+++ b/arch/arm/plat-rk/include/plat/iomux.h
@@ -3,7 +3,7 @@
 
 #define INVALID_MODE	0xffffffff
 
-#define iomux_switch_gpio_mode(m)	((m) & 0x03)
+#define iomux_switch_gpio_mode(m)	((m) & (~0x03))
 
 int iomux_gpio_to_mode(int gpio);
 int iomux_mode_to_gpio(unsigned int mode);