ASoC: Ux500: Move MSP pinctrl setup into the MSP driver

In the initial submission of the MSP driver msp1 and msp3's associated
pinctrl mechanism was passed back to platform code using a plat_init()
call-back routine, but it has no place in platform code. The MSP driver
should set this up for the appropriate ports. Instead we use a use_pinctrl
identifier which is passed from platform_data/Device Tree which indicates
which ports should use pinctrl.

Acked-by: Ola Lilja <ola.o.lilja@stericsson.com>
Acked-by: Linus Walleij <linus.walleij@linaro.org>
Signed-off-by: Lee Jones <lee.jones@linaro.org>

diff --git a/arch/arm/mach-ux500/board-mop500-msp.c b/arch/arm/mach-ux500/board-mop500-msp.c
index df15646..ace6c05 100644 (file)
--- a/arch/arm/mach-ux500/board-mop500-msp.c
+++ b/arch/arm/mach-ux500/board-mop500-msp.c
@@ -7,7 +7,6 @@
 #include <linux/platform_device.h>
 #include <linux/init.h>
 #include <linux/gpio.h>
-#include <linux/pinctrl/consumer.h>
 
 #include <plat/gpio-nomadik.h>
 #include <plat/pincfg.h>
@@ -23,53 +22,6 @@
 #include "devices-db8500.h"
 #include "pins-db8500.h"
 
-/* MSP1/3 Tx/Rx usage protection */
-static DEFINE_SPINLOCK(msp_rxtx_lock);
-
-/* Reference Count */
-static int msp_rxtx_ref;
-
-/* Pin modes */
-struct pinctrl *msp1_p;
-struct pinctrl_state *msp1_def;
-struct pinctrl_state *msp1_sleep;
-
-int msp13_i2s_init(void)
-{
-       int retval = 0;
-       unsigned long flags;
-
-       spin_lock_irqsave(&msp_rxtx_lock, flags);
-       if (msp_rxtx_ref == 0 && !(IS_ERR(msp1_p) || IS_ERR(msp1_def))) {
-               retval = pinctrl_select_state(msp1_p, msp1_def);
-               if (retval)
-                       pr_err("could not set MSP1 defstate\n");
-       }
-       if (!retval)
-               msp_rxtx_ref++;
-       spin_unlock_irqrestore(&msp_rxtx_lock, flags);
-
-       return retval;
-}
-
-int msp13_i2s_exit(void)
-{
-       int retval = 0;
-       unsigned long flags;
-
-       spin_lock_irqsave(&msp_rxtx_lock, flags);
-       WARN_ON(!msp_rxtx_ref);
-       msp_rxtx_ref--;
-       if (msp_rxtx_ref == 0 && !(IS_ERR(msp1_p) || IS_ERR(msp1_sleep))) {
-               retval = pinctrl_select_state(msp1_p, msp1_sleep);
-               if (retval)
-                       pr_err("could not set MSP1 sleepstate\n");
-       }
-       spin_unlock_irqrestore(&msp_rxtx_lock, flags);
-
-       return retval;
-}
-
 static struct stedma40_chan_cfg msp0_dma_rx = {
        .high_priority = true,
        .dir = STEDMA40_PERIPH_TO_MEM,
@@ -132,8 +84,6 @@ static struct msp_i2s_platform_data msp1_platform_data = {
        .id = MSP_I2S_1,
        .msp_i2s_dma_rx = NULL,
        .msp_i2s_dma_tx = &msp1_dma_tx,
-       .msp_i2s_init = msp13_i2s_init,
-       .msp_i2s_exit = msp13_i2s_exit,
 };
 
 static struct stedma40_chan_cfg msp2_dma_rx = {
@@ -219,49 +169,22 @@ static struct msp_i2s_platform_data msp3_platform_data = {
        .id             = MSP_I2S_3,
        .msp_i2s_dma_rx = &msp1_dma_rx,
        .msp_i2s_dma_tx = NULL,
-       .msp_i2s_init = msp13_i2s_init,
-       .msp_i2s_exit = msp13_i2s_exit,
 };
 
 int mop500_msp_init(struct device *parent)
 {
-       struct platform_device *msp1;
-
        pr_info("%s: Register platform-device 'snd-soc-mop500'.\n", __func__);
        platform_device_register(&snd_soc_mop500);
 
        pr_info("Initialize MSP I2S-devices.\n");
        db8500_add_msp_i2s(parent, 0, U8500_MSP0_BASE, IRQ_DB8500_MSP0,
                           &msp0_platform_data);
-       msp1 = db8500_add_msp_i2s(parent, 1, U8500_MSP1_BASE, IRQ_DB8500_MSP1,
+       db8500_add_msp_i2s(parent, 1, U8500_MSP1_BASE, IRQ_DB8500_MSP1,
                           &msp1_platform_data);
        db8500_add_msp_i2s(parent, 2, U8500_MSP2_BASE, IRQ_DB8500_MSP2,
                           &msp2_platform_data);
        db8500_add_msp_i2s(parent, 3, U8500_MSP3_BASE, IRQ_DB8500_MSP1,
                           &msp3_platform_data);
 
-       /* Get the pinctrl handle for MSP1 */
-       if (msp1) {
-               msp1_p = pinctrl_get(&msp1->dev);
-               if (IS_ERR(msp1_p))
-                       dev_err(&msp1->dev, "could not get MSP1 pinctrl\n");
-               else {
-                       msp1_def = pinctrl_lookup_state(msp1_p,
-                                                       PINCTRL_STATE_DEFAULT);
-                       if (IS_ERR(msp1_def)) {
-                               dev_err(&msp1->dev,
-                                       "could not get MSP1 defstate\n");
-                       }
-                       msp1_sleep = pinctrl_lookup_state(msp1_p,
-                                                         PINCTRL_STATE_SLEEP);
-                       if (IS_ERR(msp1_sleep))
-                               dev_err(&msp1->dev,
-                                       "could not get MSP1 idlestate\n");
-               }
-       }
-
-       pr_info("%s: Register platform-device 'ux500-pcm'\n", __func__);
-       platform_device_register(&ux500_pcm);
-
        return 0;
 }

diff --git a/arch/arm/mach-ux500/include/mach/msp.h b/arch/arm/mach-ux500/include/mach/msp.h
index 798be19..3cc7142 100644 (file)
--- a/arch/arm/mach-ux500/include/mach/msp.h
+++ b/arch/arm/mach-ux500/include/mach/msp.h
@@ -22,8 +22,6 @@ struct msp_i2s_platform_data {
        enum msp_i2s_id id;
        struct stedma40_chan_cfg *msp_i2s_dma_rx;
        struct stedma40_chan_cfg *msp_i2s_dma_tx;
-       int (*msp_i2s_init) (void);
-       int (*msp_i2s_exit) (void);
 };
 
 #endif

diff --git a/sound/soc/ux500/ux500_msp_i2s.c b/sound/soc/ux500/ux500_msp_i2s.c
index eb85113..12d7f56 100644 (file)
--- a/sound/soc/ux500/ux500_msp_i2s.c
+++ b/sound/soc/ux500/ux500_msp_i2s.c
@@ -15,6 +15,7 @@
 
 #include <linux/module.h>
 #include <linux/platform_device.h>
+#include <linux/pinctrl/consumer.h>
 #include <linux/delay.h>
 #include <linux/slab.h>
 
@@ -25,6 +26,9 @@
 
 #include "ux500_msp_i2s.h"
 
+/* MSP1/3 Tx/Rx usage protection */
+static DEFINE_SPINLOCK(msp_rxtx_lock);
+
  /* Protocol desciptors */
 static const struct msp_protdesc prot_descs[] = {
        { /* I2S */
@@ -352,17 +356,23 @@ static int configure_multichannel(struct ux500_msp *msp,
 
 static int enable_msp(struct ux500_msp *msp, struct ux500_msp_config *config)
 {
-       int status = 0;
+       int status = 0, retval = 0;
        u32 reg_val_DMACR, reg_val_GCR;
+       unsigned long flags;
 
        /* Check msp state whether in RUN or CONFIGURED Mode */
-       if ((msp->msp_state == MSP_STATE_IDLE) && (msp->plat_init)) {
-               status = msp->plat_init();
-               if (status) {
-                       dev_err(msp->dev, "%s: ERROR: Failed to init MSP (%d)!\n",
-                               __func__, status);
-                       return status;
+       if (msp->msp_state == MSP_STATE_IDLE) {
+               spin_lock_irqsave(&msp_rxtx_lock, flags);
+               if (msp->pinctrl_rxtx_ref == 0 &&
+                       !(IS_ERR(msp->pinctrl_p) || IS_ERR(msp->pinctrl_def))) {
+                       retval = pinctrl_select_state(msp->pinctrl_p,
+                                               msp->pinctrl_def);
+                       if (retval)
+                               pr_err("could not set MSP defstate\n");
                }
+               if (!retval)
+                       msp->pinctrl_rxtx_ref++;
+               spin_unlock_irqrestore(&msp_rxtx_lock, flags);
        }
 
        /* Configure msp with protocol dependent settings */
@@ -620,7 +630,8 @@ int ux500_msp_i2s_trigger(struct ux500_msp *msp, int cmd, int direction)
 
 int ux500_msp_i2s_close(struct ux500_msp *msp, unsigned int dir)
 {
-       int status = 0;
+       int status = 0, retval = 0;
+       unsigned long flags;
 
        dev_dbg(msp->dev, "%s: Enter (dir = 0x%01x).\n", __func__, dir);
 
@@ -631,12 +642,19 @@ int ux500_msp_i2s_close(struct ux500_msp *msp, unsigned int dir)
                writel((readl(msp->registers + MSP_GCR) &
                               (~(FRAME_GEN_ENABLE | SRG_ENABLE))),
                              msp->registers + MSP_GCR);
-               if (msp->plat_exit)
-                       status = msp->plat_exit();
-                       if (status)
-                               dev_warn(msp->dev,
-                                       "%s: WARN: ux500_msp_i2s_exit failed (%d)!\n",
-                                       __func__, status);
+
+               spin_lock_irqsave(&msp_rxtx_lock, flags);
+               WARN_ON(!msp->pinctrl_rxtx_ref);
+               msp->pinctrl_rxtx_ref--;
+               if (msp->pinctrl_rxtx_ref == 0 &&
+                       !(IS_ERR(msp->pinctrl_p) || IS_ERR(msp->pinctrl_sleep))) {
+                       retval = pinctrl_select_state(msp->pinctrl_p,
+                                               msp->pinctrl_sleep);
+                       if (retval)
+                               pr_err("could not set MSP sleepstate\n");
+               }
+               spin_unlock_irqrestore(&msp_rxtx_lock, flags);
+
                writel(0, msp->registers + MSP_GCR);
                writel(0, msp->registers + MSP_TCF);
                writel(0, msp->registers + MSP_RCF);
@@ -675,8 +693,6 @@ int ux500_msp_i2s_init_msp(struct platform_device *pdev,
 
        msp->id = platform_data->id;
        msp->dev = &pdev->dev;
-       msp->plat_init = platform_data->msp_i2s_init;
-       msp->plat_exit = platform_data->msp_i2s_exit;
        msp->dma_cfg_rx = platform_data->msp_i2s_dma_rx;
        msp->dma_cfg_tx = platform_data->msp_i2s_dma_tx;
 
@@ -713,6 +729,25 @@ int ux500_msp_i2s_init_msp(struct platform_device *pdev,
        dev_dbg(&pdev->dev, "I2S device-name: '%s'\n", i2s_cont->name);
        msp->i2s_cont = i2s_cont;
 
+       msp->pinctrl_p = pinctrl_get(msp->dev);
+       if (IS_ERR(msp->pinctrl_p))
+               dev_err(&pdev->dev, "could not get MSP pinctrl\n");
+       else {
+               msp->pinctrl_def = pinctrl_lookup_state(msp->pinctrl_p,
+                                               PINCTRL_STATE_DEFAULT);
+               if (IS_ERR(msp->pinctrl_def)) {
+                       dev_err(&pdev->dev,
+                               "could not get MSP defstate (%li)\n",
+                               PTR_ERR(msp->pinctrl_def));
+               }
+               msp->pinctrl_sleep = pinctrl_lookup_state(msp->pinctrl_p,
+                                               PINCTRL_STATE_SLEEP);
+               if (IS_ERR(msp->pinctrl_sleep))
+                       dev_err(&pdev->dev,
+                               "could not get MSP idlestate (%li)\n",
+                               PTR_ERR(msp->pinctrl_def));
+       }
+
        return 0;
 }
 

diff --git a/sound/soc/ux500/ux500_msp_i2s.h b/sound/soc/ux500/ux500_msp_i2s.h
index 2d9136d..1311c0d 100644 (file)
--- a/sound/soc/ux500/ux500_msp_i2s.h
+++ b/sound/soc/ux500/ux500_msp_i2s.h
@@ -524,14 +524,18 @@ struct ux500_msp {
        struct dma_chan *rx_pipeid;
        enum msp_state msp_state;
        int (*transfer) (struct ux500_msp *msp, struct i2s_message *message);
-       int (*plat_init) (void);
-       int (*plat_exit) (void);
        struct timer_list notify_timer;
        int def_elem_len;
        unsigned int dir_busy;
        int loopback_enable;
        u32 backup_regs[MAX_MSP_BACKUP_REGS];
        unsigned int f_bitclk;
+       /* Pin modes */
+       struct pinctrl *pinctrl_p;
+       struct pinctrl_state *pinctrl_def;
+       struct pinctrl_state *pinctrl_sleep;
+       /* Reference Count */
+       int pinctrl_rxtx_ref;
 };
 
 struct ux500_msp_dma_params {