-//#define LCD_CMD_SETFUNC 0x38 /**< 8 bits, 2 lines, 5x7 dots */
-#define LCD_CMD_SETFUNC 0x28 /**< 4 bits, 2 lines, 5x7 dots */
+
+#if CONFIG_LCD_4BIT
+ #define LCD_CMD_SETFUNC 0x28 /**< 4 bits, 2 lines, 5x7 dots */
+#else
+ #define LCD_CMD_SETFUNC 0x38 /**< 8 bits, 2 lines, 5x7 dots */
+#endif
+