![Ola Lilja](/assets/img/avatar_default.png)
Create devices for the MSP-blocks (MSP0, MSP1, MSP2 and MSP3) and associate it with the correct clocks in the clock-framework. Signed-off-by: Ola Lilja <ola.o.lilja@stericsson.com> Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
251 lines
6.1 KiB
C
251 lines
6.1 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 <plat/gpio-nomadik.h>
|
|
|
|
#include <plat/pincfg.h>
|
|
#include <plat/ste_dma40.h>
|
|
|
|
#include <mach/devices.h>
|
|
#include <ste-dma40-db8500.h>
|
|
#include <mach/hardware.h>
|
|
#include <mach/irqs.h>
|
|
#include <mach/msp.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;
|
|
|
|
static pin_cfg_t mop500_msp1_pins_init[] = {
|
|
GPIO33_MSP1_TXD | PIN_OUTPUT_LOW | PIN_SLPM_WAKEUP_DISABLE,
|
|
GPIO34_MSP1_TFS | PIN_INPUT_NOPULL | PIN_SLPM_WAKEUP_DISABLE,
|
|
GPIO35_MSP1_TCK | PIN_INPUT_NOPULL | PIN_SLPM_WAKEUP_DISABLE,
|
|
GPIO36_MSP1_RXD | PIN_INPUT_NOPULL | PIN_SLPM_WAKEUP_DISABLE,
|
|
};
|
|
|
|
static pin_cfg_t mop500_msp1_pins_exit[] = {
|
|
GPIO33_MSP1_TXD | PIN_OUTPUT_LOW | PIN_SLPM_WAKEUP_ENABLE,
|
|
GPIO34_MSP1_TFS | PIN_INPUT_NOPULL | PIN_SLPM_WAKEUP_ENABLE,
|
|
GPIO35_MSP1_TCK | PIN_INPUT_NOPULL | PIN_SLPM_WAKEUP_ENABLE,
|
|
GPIO36_MSP1_RXD | PIN_INPUT_NOPULL | PIN_SLPM_WAKEUP_ENABLE,
|
|
};
|
|
|
|
int msp13_i2s_init(void)
|
|
{
|
|
int retval = 0;
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave(&msp_rxtx_lock, flags);
|
|
if (msp_rxtx_ref == 0)
|
|
retval = nmk_config_pins(
|
|
ARRAY_AND_SIZE(mop500_msp1_pins_init));
|
|
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)
|
|
retval = nmk_config_pins_sleep(
|
|
ARRAY_AND_SIZE(mop500_msp1_pins_exit));
|
|
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 int 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 -EIO;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Platform device for ASoC U8500 machine */
|
|
static struct platform_device snd_soc_u8500 = {
|
|
.name = "snd-soc-u8500",
|
|
.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)
|
|
{
|
|
int ret;
|
|
|
|
pr_info("%s: Register platform-device 'snd-soc-u8500'.\n", __func__);
|
|
platform_device_register(&snd_soc_u8500);
|
|
|
|
pr_info("Initialize MSP I2S-devices.\n");
|
|
ret = db8500_add_msp_i2s(parent, 0, U8500_MSP0_BASE, IRQ_DB8500_MSP0,
|
|
&msp0_platform_data);
|
|
ret |= db8500_add_msp_i2s(parent, 1, U8500_MSP1_BASE, IRQ_DB8500_MSP1,
|
|
&msp1_platform_data);
|
|
ret |= db8500_add_msp_i2s(parent, 2, U8500_MSP2_BASE, IRQ_DB8500_MSP2,
|
|
&msp2_platform_data);
|
|
ret |= db8500_add_msp_i2s(parent, 3, U8500_MSP3_BASE, IRQ_DB8500_MSP1,
|
|
&msp3_platform_data);
|
|
|
|
pr_info("%s: Register platform-device 'ux500-pcm'\n", __func__);
|
|
platform_device_register(&ux500_pcm);
|
|
|
|
return ret;
|
|
}
|