[ARM] pxa: make ads7846 on corgi and spitz to sync on HSYNC

Signed-off-by: Eric Miao <eric.miao@marvell.com>

2 files changed, 20 insertions, 0 deletions

diff --git a/arch/arm/mach-pxa/corgi.c b/arch/arm/mach-pxa/corgi.c
index cdf21dd135b4..930e364ccde9 100644
--- a/arch/arm/mach-pxa/corgi.c
+++ b/arch/arm/mach-pxa/corgi.c
@@ -427,12 +427,22 @@ static struct pxa2xx_spi_master corgi_spi_info = {
         .num_chipselect = 3,
 };
 
+static void corgi_wait_for_hsync(void)
+{
+        while (gpio_get_value(CORGI_GPIO_HSYNC))
+                cpu_relax();
+
+        while (!gpio_get_value(CORGI_GPIO_HSYNC))
+                cpu_relax();
+}
+
 static struct ads7846_platform_data corgi_ads7846_info = {
         .model                  = 7846,
         .vref_delay_usecs       = 100,
         .x_plate_ohms           = 419,
         .y_plate_ohms           = 486,
         .gpio_pendown           = CORGI_GPIO_TP_INT,
+        .wait_for_sync          = corgi_wait_for_hsync,
 };
 
 static void corgi_ads7846_cs(u32 command)
diff --git a/arch/arm/mach-pxa/spitz.c b/arch/arm/mach-pxa/spitz.c
index 8c61ddac119e..c18e34acafcb 100644
--- a/arch/arm/mach-pxa/spitz.c
+++ b/arch/arm/mach-pxa/spitz.c
@@ -299,12 +299,22 @@ static struct pxa2xx_spi_master spitz_spi_info = {
         .num_chipselect = 3,
 };
 
+static void spitz_wait_for_hsync(void)
+{
+        while (gpio_get_value(SPITZ_GPIO_HSYNC))
+                cpu_relax();
+
+        while (!gpio_get_value(SPITZ_GPIO_HSYNC))
+                cpu_relax();
+}
+
 static struct ads7846_platform_data spitz_ads7846_info = {
         .model                  = 7846,
         .vref_delay_usecs       = 100,
         .x_plate_ohms           = 419,
         .y_plate_ohms           = 486,
         .gpio_pendown           = SPITZ_GPIO_TP_INT,
+        .wait_for_sync          = spitz_wait_for_hsync,
 };
 
 static void spitz_ads7846_cs(u32 command)