2 files changed, 17 insertions, 3 deletions

diff --git a/arch/arm/mach-pxa/include/mach/regs-lcd.h b/arch/arm/mach-pxa/include/mach/regs-lcd.h
index c689c4ea769c..f817878d256b 100644
--- a/arch/arm/mach-pxa/include/mach/regs-lcd.h
+++ b/arch/arm/mach-pxa/include/mach/regs-lcd.h
@@ -177,4 +177,11 @@
 
 #define SMART_CMD(x)    (SMART_CMD_WRITE_COMMAND | ((x) & 0xff))
 #define SMART_DAT(x)    (SMART_CMD_WRITE_DATA | ((x) & 0xff))
+
+/* SMART_DELAY() is introduced for software controlled delay primitive which
+ * can be inserted between command sequences, unused command 0x6 is used here
+ * and delay ranges from 0ms ~ 255ms
+ */
+#define SMART_CMD_DELAY         (0x6 << 9)
+#define SMART_DELAY(ms)         (SMART_CMD_DELAY | ((ms) & 0xff))
 #endif /* __ASM_ARCH_REGS_LCD_H */
diff --git a/drivers/video/pxafb.c b/drivers/video/pxafb.c
index d6de84b42036..1e1c4ec0d3b9 100644
--- a/drivers/video/pxafb.c
+++ b/drivers/video/pxafb.c
@@ -723,12 +723,19 @@ int pxafb_smart_queue(struct fb_info *info, uint16_t *cmds, int n_cmds)
         int i;
         struct pxafb_info *fbi = container_of(info, struct pxafb_info, fb);
 
-        /* leave 2 commands for INTERRUPT and WAIT_FOR_SYNC */
-        for (i = 0; i < n_cmds; i++) {
+        for (i = 0; i < n_cmds; i++, cmds++) {
+                /* if it is a software delay, flush and delay */
+                if ((*cmds & 0xff00) == SMART_CMD_DELAY) {
+                        pxafb_smart_flush(info);
+                        mdelay(*cmds & 0xff);
+                        continue;
+                }
+
+                /* leave 2 commands for INTERRUPT and WAIT_FOR_SYNC */
                 if (fbi->n_smart_cmds == CMD_BUFF_SIZE - 8)
                         pxafb_smart_flush(info);
 
-                fbi->smart_cmds[fbi->n_smart_cmds++] = *cmds++;
+                fbi->smart_cmds[fbi->n_smart_cmds++] = *cmds;
         }
 
         return 0;