1 files changed, 57 insertions, 29 deletions

diff --git a/drivers/spi/spi-clps711x.c b/drivers/spi/spi-clps711x.c
index ab010c05dc5a..d9eec4e3b246 100644
--- a/drivers/spi/spi-clps711x.c
+++ b/drivers/spi/spi-clps711x.c
@@ -17,14 +17,21 @@
 #include <linux/module.h>
 #include <linux/interrupt.h>
 #include <linux/platform_device.h>
+#include <linux/regmap.h>
+#include <linux/mfd/syscon.h>
+#include <linux/mfd/syscon/clps711x.h>
 #include <linux/spi/spi.h>
 #include <linux/platform_data/spi-clps711x.h>
 
-#include <mach/hardware.h>
-
 #define DRIVER_NAME     "spi-clps711x"
 
+#define SYNCIO_FRMLEN(x)        ((x) << 8)
+#define SYNCIO_TXFRMEN          (1 << 14)
+
 struct spi_clps711x_data {
+        void __iomem            *syncio;
+        struct regmap           *syscon;
+        struct regmap           *syscon1;
         struct clk              *spi_clk;
         u32                     max_speed_hz;
 
@@ -49,31 +56,29 @@ static void spi_clps711x_setup_xfer(struct spi_device *spi,
 
         /* Setup SPI frequency divider */
         if (!xfer->speed_hz || (xfer->speed_hz >= hw->max_speed_hz))
-                clps_writel((clps_readl(SYSCON1) & ~SYSCON1_ADCKSEL_MASK) |
-                            SYSCON1_ADCKSEL(3), SYSCON1);
+                regmap_update_bits(hw->syscon1, SYSCON_OFFSET,
+                                   SYSCON1_ADCKSEL_MASK, SYSCON1_ADCKSEL(3));
         else if (xfer->speed_hz >= (hw->max_speed_hz / 2))
-                clps_writel((clps_readl(SYSCON1) & ~SYSCON1_ADCKSEL_MASK) |
-                            SYSCON1_ADCKSEL(2), SYSCON1);
+                regmap_update_bits(hw->syscon1, SYSCON_OFFSET,
+                                   SYSCON1_ADCKSEL_MASK, SYSCON1_ADCKSEL(2));
         else if (xfer->speed_hz >= (hw->max_speed_hz / 8))
-                clps_writel((clps_readl(SYSCON1) & ~SYSCON1_ADCKSEL_MASK) |
-                            SYSCON1_ADCKSEL(1), SYSCON1);
+                regmap_update_bits(hw->syscon1, SYSCON_OFFSET,
+                                   SYSCON1_ADCKSEL_MASK, SYSCON1_ADCKSEL(1));
         else
-                clps_writel((clps_readl(SYSCON1) & ~SYSCON1_ADCKSEL_MASK) |
-                            SYSCON1_ADCKSEL(0), SYSCON1);
+                regmap_update_bits(hw->syscon1, SYSCON_OFFSET,
+                                   SYSCON1_ADCKSEL_MASK, SYSCON1_ADCKSEL(0));
 }
 
 static int spi_clps711x_prepare_message(struct spi_master *master,
                                         struct spi_message *msg)
 {
+        struct spi_clps711x_data *hw = spi_master_get_devdata(master);
         struct spi_device *spi = msg->spi;
 
-        /* Setup edge for transfer */
-        if (spi->mode & SPI_CPHA)
-                clps_writew(clps_readw(SYSCON3) | SYSCON3_ADCCKNSEN, SYSCON3);
-        else
-                clps_writew(clps_readw(SYSCON3) & ~SYSCON3_ADCCKNSEN, SYSCON3);
-
-        return 0;
+        /* Setup mode for transfer */
+        return regmap_update_bits(hw->syscon, SYSCON_OFFSET, SYSCON3_ADCCKNSEN,
+                                  (spi->mode & SPI_CPHA) ?
+                                  SYSCON3_ADCCKNSEN : 0);
 }
 
 static int spi_clps711x_transfer_one(struct spi_master *master,
@@ -92,7 +97,8 @@ static int spi_clps711x_transfer_one(struct spi_master *master,
 
         /* Initiate transfer */
         data = hw->tx_buf ? *hw->tx_buf++ : 0;
-        clps_writel(data | SYNCIO_FRMLEN(hw->bpw) | SYNCIO_TXFRMEN, SYNCIO);
+        writel(data | SYNCIO_FRMLEN(hw->bpw) | SYNCIO_TXFRMEN, hw->syncio);
+
         return 1;
 }
 
@@ -103,15 +109,15 @@ static irqreturn_t spi_clps711x_isr(int irq, void *dev_id)
         u8 data;
 
         /* Handle RX */
-        data = clps_readb(SYNCIO);
+        data = readb(hw->syncio);
         if (hw->rx_buf)
                 *hw->rx_buf++ = data;
 
         /* Handle TX */
         if (--hw->len > 0) {
                 data = hw->tx_buf ? *hw->tx_buf++ : 0;
-                clps_writel(data | SYNCIO_FRMLEN(hw->bpw) | SYNCIO_TXFRMEN,
-                            SYNCIO);
+                writel(data | SYNCIO_FRMLEN(hw->bpw) | SYNCIO_TXFRMEN,
+                       hw->syncio);
         } else
                 spi_finalize_current_transfer(master);
 
@@ -120,10 +126,11 @@ static irqreturn_t spi_clps711x_isr(int irq, void *dev_id)
 
 static int spi_clps711x_probe(struct platform_device *pdev)
 {
-        int i, ret;
-        struct spi_master *master;
         struct spi_clps711x_data *hw;
         struct spi_clps711x_pdata *pdata = dev_get_platdata(&pdev->dev);
+        struct spi_master *master;
+        struct resource *res;
+        int i, irq, ret;
 
         if (!pdata) {
                 dev_err(&pdev->dev, "No platform data supplied\n");
@@ -135,6 +142,10 @@ static int spi_clps711x_probe(struct platform_device *pdev)
                 return -EINVAL;
         }
 
+        irq = platform_get_irq(pdev, 0);
+        if (irq < 0)
+                return irq;
+
         master = spi_alloc_master(&pdev->dev, sizeof(*hw));
         if (!master)
                 return -ENOMEM;
@@ -176,18 +187,35 @@ static int spi_clps711x_probe(struct platform_device *pdev)
 
         platform_set_drvdata(pdev, master);
 
+        hw->syscon = syscon_regmap_lookup_by_pdevname("syscon.3");
+        if (IS_ERR(hw->syscon)) {
+                ret = PTR_ERR(hw->syscon);
+                goto err_out;
+        }
+
+        hw->syscon1 = syscon_regmap_lookup_by_pdevname("syscon.1");
+        if (IS_ERR(hw->syscon1)) {
+                ret = PTR_ERR(hw->syscon1);
+                goto err_out;
+        }
+
+        res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+        hw->syncio = devm_ioremap_resource(&pdev->dev, res);
+        if (IS_ERR(hw->syncio)) {
+                ret = PTR_ERR(hw->syncio);
+                goto err_out;
+        }
+
         /* Disable extended mode due hardware problems */
-        clps_writew(clps_readw(SYSCON3) & ~SYSCON3_ADCCON, SYSCON3);
+        regmap_update_bits(hw->syscon, SYSCON_OFFSET, SYSCON3_ADCCON, 0);
 
         /* Clear possible pending interrupt */
-        clps_readl(SYNCIO);
+        readl(hw->syncio);
 
-        ret = devm_request_irq(&pdev->dev, IRQ_SSEOTI, spi_clps711x_isr, 0,
+        ret = devm_request_irq(&pdev->dev, irq, spi_clps711x_isr, 0,
                                dev_name(&pdev->dev), master);
-        if (ret) {
-                dev_err(&pdev->dev, "Can't request IRQ\n");
+        if (ret)
                 goto err_out;
-        }
 
         ret = devm_spi_register_master(&pdev->dev, master);
         if (!ret) {