forked from luck/tmp_suning_uos_patched
97f50c6c41
The platform attempts to register platform device 'snd_soc_u8500' which doesn't actually exist. Here we change the reference to the correct one 'snd_soc_mop500'. Signed-off-by: Lee Jones <lee.jones@linaro.org> Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
268 lines
6.4 KiB
C
268 lines
6.4 KiB
C
/*
|
|
* Copyright (C) ST-Ericsson SA 2010
|
|
*
|
|
* License terms: GNU General Public License (GPL), version 2
|
|
*/
|
|
|
|
#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>
|
|
#include <plat/ste_dma40.h>
|
|
|
|
#include <mach/devices.h>
|
|
#include <mach/hardware.h>
|
|
#include <mach/irqs.h>
|
|
#include <mach/msp.h>
|
|
|
|
#include "ste-dma40-db8500.h"
|
|
#include "board-mop500.h"
|
|
#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,
|
|
|
|
.src_dev_type = DB8500_DMA_DEV31_MSP0_RX_SLIM0_CH0_RX,
|
|
.dst_dev_type = STEDMA40_DEV_DST_MEMORY,
|
|
|
|
.src_info.psize = STEDMA40_PSIZE_LOG_4,
|
|
.dst_info.psize = STEDMA40_PSIZE_LOG_4,
|
|
|
|
/* data_width is set during configuration */
|
|
};
|
|
|
|
static struct stedma40_chan_cfg msp0_dma_tx = {
|
|
.high_priority = true,
|
|
.dir = STEDMA40_MEM_TO_PERIPH,
|
|
|
|
.src_dev_type = STEDMA40_DEV_DST_MEMORY,
|
|
.dst_dev_type = DB8500_DMA_DEV31_MSP0_TX_SLIM0_CH0_TX,
|
|
|
|
.src_info.psize = STEDMA40_PSIZE_LOG_4,
|
|
.dst_info.psize = STEDMA40_PSIZE_LOG_4,
|
|
|
|
/* data_width is set during configuration */
|
|
};
|
|
|
|
static struct msp_i2s_platform_data msp0_platform_data = {
|
|
.id = MSP_I2S_0,
|
|
.msp_i2s_dma_rx = &msp0_dma_rx,
|
|
.msp_i2s_dma_tx = &msp0_dma_tx,
|
|
};
|
|
|
|
static struct stedma40_chan_cfg msp1_dma_rx = {
|
|
.high_priority = true,
|
|
.dir = STEDMA40_PERIPH_TO_MEM,
|
|
|
|
.src_dev_type = DB8500_DMA_DEV30_MSP3_RX,
|
|
.dst_dev_type = STEDMA40_DEV_DST_MEMORY,
|
|
|
|
.src_info.psize = STEDMA40_PSIZE_LOG_4,
|
|
.dst_info.psize = STEDMA40_PSIZE_LOG_4,
|
|
|
|
/* data_width is set during configuration */
|
|
};
|
|
|
|
static struct stedma40_chan_cfg msp1_dma_tx = {
|
|
.high_priority = true,
|
|
.dir = STEDMA40_MEM_TO_PERIPH,
|
|
|
|
.src_dev_type = STEDMA40_DEV_DST_MEMORY,
|
|
.dst_dev_type = DB8500_DMA_DEV30_MSP1_TX,
|
|
|
|
.src_info.psize = STEDMA40_PSIZE_LOG_4,
|
|
.dst_info.psize = STEDMA40_PSIZE_LOG_4,
|
|
|
|
/* data_width is set during configuration */
|
|
};
|
|
|
|
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 = {
|
|
.high_priority = true,
|
|
.dir = STEDMA40_PERIPH_TO_MEM,
|
|
|
|
.src_dev_type = DB8500_DMA_DEV14_MSP2_RX,
|
|
.dst_dev_type = STEDMA40_DEV_DST_MEMORY,
|
|
|
|
/* MSP2 DMA doesn't work with PSIZE == 4 on DB8500v2 */
|
|
.src_info.psize = STEDMA40_PSIZE_LOG_1,
|
|
.dst_info.psize = STEDMA40_PSIZE_LOG_1,
|
|
|
|
/* data_width is set during configuration */
|
|
};
|
|
|
|
static struct stedma40_chan_cfg msp2_dma_tx = {
|
|
.high_priority = true,
|
|
.dir = STEDMA40_MEM_TO_PERIPH,
|
|
|
|
.src_dev_type = STEDMA40_DEV_DST_MEMORY,
|
|
.dst_dev_type = DB8500_DMA_DEV14_MSP2_TX,
|
|
|
|
.src_info.psize = STEDMA40_PSIZE_LOG_4,
|
|
.dst_info.psize = STEDMA40_PSIZE_LOG_4,
|
|
|
|
.use_fixed_channel = true,
|
|
.phy_channel = 1,
|
|
|
|
/* data_width is set during configuration */
|
|
};
|
|
|
|
static struct platform_device *db8500_add_msp_i2s(struct device *parent,
|
|
int id,
|
|
resource_size_t base, int irq,
|
|
struct msp_i2s_platform_data *pdata)
|
|
{
|
|
struct platform_device *pdev;
|
|
struct resource res[] = {
|
|
DEFINE_RES_MEM(base, SZ_4K),
|
|
DEFINE_RES_IRQ(irq),
|
|
};
|
|
|
|
pr_info("Register platform-device 'ux500-msp-i2s', id %d, irq %d\n",
|
|
id, irq);
|
|
pdev = platform_device_register_resndata(parent, "ux500-msp-i2s", id,
|
|
res, ARRAY_SIZE(res),
|
|
pdata, sizeof(*pdata));
|
|
if (!pdev) {
|
|
pr_err("Failed to register platform-device 'ux500-msp-i2s.%d'!\n",
|
|
id);
|
|
return NULL;
|
|
}
|
|
|
|
return pdev;
|
|
}
|
|
|
|
/* Platform device for ASoC MOP500 machine */
|
|
static struct platform_device snd_soc_mop500 = {
|
|
.name = "snd-soc-mop500",
|
|
.id = 0,
|
|
.dev = {
|
|
.platform_data = NULL,
|
|
},
|
|
};
|
|
|
|
/* Platform device for Ux500-PCM */
|
|
static struct platform_device ux500_pcm = {
|
|
.name = "ux500-pcm",
|
|
.id = 0,
|
|
.dev = {
|
|
.platform_data = NULL,
|
|
},
|
|
};
|
|
|
|
static struct msp_i2s_platform_data msp2_platform_data = {
|
|
.id = MSP_I2S_2,
|
|
.msp_i2s_dma_rx = &msp2_dma_rx,
|
|
.msp_i2s_dma_tx = &msp2_dma_tx,
|
|
};
|
|
|
|
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,
|
|
&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;
|
|
}
|