Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 5ca032ee authored by Lee Jones's avatar Lee Jones
Browse files

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: default avatarOla Lilja <ola.o.lilja@stericsson.com>
Acked-by: default avatarLinus Walleij <linus.walleij@linaro.org>
Signed-off-by: default avatarLee Jones <lee.jones@linaro.org>
parent 5698bd75
Loading
Loading
Loading
Loading
+1 −78
Original line number Original line Diff line number Diff line
@@ -7,7 +7,6 @@
#include <linux/platform_device.h>
#include <linux/platform_device.h>
#include <linux/init.h>
#include <linux/init.h>
#include <linux/gpio.h>
#include <linux/gpio.h>
#include <linux/pinctrl/consumer.h>


#include <plat/gpio-nomadik.h>
#include <plat/gpio-nomadik.h>
#include <plat/pincfg.h>
#include <plat/pincfg.h>
@@ -23,53 +22,6 @@
#include "devices-db8500.h"
#include "devices-db8500.h"
#include "pins-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 = {
static struct stedma40_chan_cfg msp0_dma_rx = {
	.high_priority = true,
	.high_priority = true,
	.dir = STEDMA40_PERIPH_TO_MEM,
	.dir = STEDMA40_PERIPH_TO_MEM,
@@ -132,8 +84,6 @@ static struct msp_i2s_platform_data msp1_platform_data = {
	.id = MSP_I2S_1,
	.id = MSP_I2S_1,
	.msp_i2s_dma_rx = NULL,
	.msp_i2s_dma_rx = NULL,
	.msp_i2s_dma_tx = &msp1_dma_tx,
	.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 = {
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,
	.id		= MSP_I2S_3,
	.msp_i2s_dma_rx	= &msp1_dma_rx,
	.msp_i2s_dma_rx	= &msp1_dma_rx,
	.msp_i2s_dma_tx	= NULL,
	.msp_i2s_dma_tx	= NULL,
	.msp_i2s_init = msp13_i2s_init,
	.msp_i2s_exit = msp13_i2s_exit,
};
};


int mop500_msp_init(struct device *parent)
int mop500_msp_init(struct device *parent)
{
{
	struct platform_device *msp1;

	pr_info("%s: Register platform-device 'snd-soc-mop500'.\n", __func__);
	pr_info("%s: Register platform-device 'snd-soc-mop500'.\n", __func__);
	platform_device_register(&snd_soc_mop500);
	platform_device_register(&snd_soc_mop500);


	pr_info("Initialize MSP I2S-devices.\n");
	pr_info("Initialize MSP I2S-devices.\n");
	db8500_add_msp_i2s(parent, 0, U8500_MSP0_BASE, IRQ_DB8500_MSP0,
	db8500_add_msp_i2s(parent, 0, U8500_MSP0_BASE, IRQ_DB8500_MSP0,
			   &msp0_platform_data);
			   &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);
			   &msp1_platform_data);
	db8500_add_msp_i2s(parent, 2, U8500_MSP2_BASE, IRQ_DB8500_MSP2,
	db8500_add_msp_i2s(parent, 2, U8500_MSP2_BASE, IRQ_DB8500_MSP2,
			   &msp2_platform_data);
			   &msp2_platform_data);
	db8500_add_msp_i2s(parent, 3, U8500_MSP3_BASE, IRQ_DB8500_MSP1,
	db8500_add_msp_i2s(parent, 3, U8500_MSP3_BASE, IRQ_DB8500_MSP1,
			   &msp3_platform_data);
			   &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;
	return 0;
}
}
+0 −2
Original line number Original line Diff line number Diff line
@@ -22,8 +22,6 @@ struct msp_i2s_platform_data {
	enum msp_i2s_id id;
	enum msp_i2s_id id;
	struct stedma40_chan_cfg *msp_i2s_dma_rx;
	struct stedma40_chan_cfg *msp_i2s_dma_rx;
	struct stedma40_chan_cfg *msp_i2s_dma_tx;
	struct stedma40_chan_cfg *msp_i2s_dma_tx;
	int (*msp_i2s_init) (void);
	int (*msp_i2s_exit) (void);
};
};


#endif
#endif
+51 −16
Original line number Original line Diff line number Diff line
@@ -15,6 +15,7 @@


#include <linux/module.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/platform_device.h>
#include <linux/pinctrl/consumer.h>
#include <linux/delay.h>
#include <linux/delay.h>
#include <linux/slab.h>
#include <linux/slab.h>


@@ -25,6 +26,9 @@


#include "ux500_msp_i2s.h"
#include "ux500_msp_i2s.h"


/* MSP1/3 Tx/Rx usage protection */
static DEFINE_SPINLOCK(msp_rxtx_lock);

 /* Protocol desciptors */
 /* Protocol desciptors */
static const struct msp_protdesc prot_descs[] = {
static const struct msp_protdesc prot_descs[] = {
	{ /* I2S */
	{ /* 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)
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;
	u32 reg_val_DMACR, reg_val_GCR;
	unsigned long flags;


	/* Check msp state whether in RUN or CONFIGURED Mode */
	/* Check msp state whether in RUN or CONFIGURED Mode */
	if ((msp->msp_state == MSP_STATE_IDLE) && (msp->plat_init)) {
	if (msp->msp_state == MSP_STATE_IDLE) {
		status = msp->plat_init();
		spin_lock_irqsave(&msp_rxtx_lock, flags);
		if (status) {
		if (msp->pinctrl_rxtx_ref == 0 &&
			dev_err(msp->dev, "%s: ERROR: Failed to init MSP (%d)!\n",
			!(IS_ERR(msp->pinctrl_p) || IS_ERR(msp->pinctrl_def))) {
				__func__, status);
			retval = pinctrl_select_state(msp->pinctrl_p,
			return status;
						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 */
	/* 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 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);
	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) &
		writel((readl(msp->registers + MSP_GCR) &
			       (~(FRAME_GEN_ENABLE | SRG_ENABLE))),
			       (~(FRAME_GEN_ENABLE | SRG_ENABLE))),
			      msp->registers + MSP_GCR);
			      msp->registers + MSP_GCR);
		if (msp->plat_exit)

			status = msp->plat_exit();
		spin_lock_irqsave(&msp_rxtx_lock, flags);
			if (status)
		WARN_ON(!msp->pinctrl_rxtx_ref);
				dev_warn(msp->dev,
		msp->pinctrl_rxtx_ref--;
					"%s: WARN: ux500_msp_i2s_exit failed (%d)!\n",
		if (msp->pinctrl_rxtx_ref == 0 &&
					__func__, status);
			!(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_GCR);
		writel(0, msp->registers + MSP_TCF);
		writel(0, msp->registers + MSP_TCF);
		writel(0, msp->registers + MSP_RCF);
		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->id = platform_data->id;
	msp->dev = &pdev->dev;
	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_rx = platform_data->msp_i2s_dma_rx;
	msp->dma_cfg_tx = platform_data->msp_i2s_dma_tx;
	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);
	dev_dbg(&pdev->dev, "I2S device-name: '%s'\n", i2s_cont->name);
	msp->i2s_cont = i2s_cont;
	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;
	return 0;
}
}


+6 −2
Original line number Original line Diff line number Diff line
@@ -524,14 +524,18 @@ struct ux500_msp {
	struct dma_chan *rx_pipeid;
	struct dma_chan *rx_pipeid;
	enum msp_state msp_state;
	enum msp_state msp_state;
	int (*transfer) (struct ux500_msp *msp, struct i2s_message *message);
	int (*transfer) (struct ux500_msp *msp, struct i2s_message *message);
	int (*plat_init) (void);
	int (*plat_exit) (void);
	struct timer_list notify_timer;
	struct timer_list notify_timer;
	int def_elem_len;
	int def_elem_len;
	unsigned int dir_busy;
	unsigned int dir_busy;
	int loopback_enable;
	int loopback_enable;
	u32 backup_regs[MAX_MSP_BACKUP_REGS];
	u32 backup_regs[MAX_MSP_BACKUP_REGS];
	unsigned int f_bitclk;
	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 {
struct ux500_msp_dma_params {