mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-28 07:04:00 +08:00
omap: McBSP: Modify macros/functions API for easy cache access
OMAP_MCBSP_READ()/_WRITE() macros and omap_mcbsp_read()/_write() functions accept McBSP register base address as an argument. In order to support caching, that must be replaced with an address of the omap_mcbsp structure that would provide addresses for both register AND cache access. Since OMAP_ prefix seems obvious in macro names, drop it off in order to minimize line wrapping throughout the file. Tested on OMAP1510 based Amstrad Delta using linux-omap for-next, commit fb7380d70e041e4b3892f6b19dff7efb609d15a4 (2.6.33-rc3+ dated 2010-01-11). Compile-tested with omap_3430sdp_defconfig. Signed-off-by: Janusz Krzysztofik <jkrzyszt@tis.icnet.pl> Acked-by: Peter Ujfalusi <peter.ujfalusi@nokia.com> Acked-by: Jarkko Nikula <jhnikula@gmail.com> Signed-off-by: Tony Lindgren <tony@atomide.com>
This commit is contained in:
parent
14f796375b
commit
8ea3200f1d
@ -30,26 +30,26 @@
|
|||||||
struct omap_mcbsp **mcbsp_ptr;
|
struct omap_mcbsp **mcbsp_ptr;
|
||||||
int omap_mcbsp_count;
|
int omap_mcbsp_count;
|
||||||
|
|
||||||
void omap_mcbsp_write(void __iomem *io_base, u16 reg, u32 val)
|
void omap_mcbsp_write(struct omap_mcbsp *mcbsp, u16 reg, u32 val)
|
||||||
{
|
{
|
||||||
if (cpu_class_is_omap1() || cpu_is_omap2420())
|
if (cpu_class_is_omap1() || cpu_is_omap2420())
|
||||||
__raw_writew((u16)val, io_base + reg);
|
__raw_writew((u16)val, mcbsp->io_base + reg);
|
||||||
else
|
else
|
||||||
__raw_writel(val, io_base + reg);
|
__raw_writel(val, mcbsp->io_base + reg);
|
||||||
}
|
}
|
||||||
|
|
||||||
int omap_mcbsp_read(void __iomem *io_base, u16 reg)
|
int omap_mcbsp_read(struct omap_mcbsp *mcbsp, u16 reg)
|
||||||
{
|
{
|
||||||
if (cpu_class_is_omap1() || cpu_is_omap2420())
|
if (cpu_class_is_omap1() || cpu_is_omap2420())
|
||||||
return __raw_readw(io_base + reg);
|
return __raw_readw(mcbsp->io_base + reg);
|
||||||
else
|
else
|
||||||
return __raw_readl(io_base + reg);
|
return __raw_readl(mcbsp->io_base + reg);
|
||||||
}
|
}
|
||||||
|
|
||||||
#define OMAP_MCBSP_READ(base, reg) \
|
#define MCBSP_READ(mcbsp, reg) \
|
||||||
omap_mcbsp_read(base, OMAP_MCBSP_REG_##reg)
|
omap_mcbsp_read(mcbsp, OMAP_MCBSP_REG_##reg)
|
||||||
#define OMAP_MCBSP_WRITE(base, reg, val) \
|
#define MCBSP_WRITE(mcbsp, reg, val) \
|
||||||
omap_mcbsp_write(base, OMAP_MCBSP_REG_##reg, val)
|
omap_mcbsp_write(mcbsp, OMAP_MCBSP_REG_##reg, val)
|
||||||
|
|
||||||
#define omap_mcbsp_check_valid_id(id) (id < omap_mcbsp_count)
|
#define omap_mcbsp_check_valid_id(id) (id < omap_mcbsp_count)
|
||||||
#define id_to_mcbsp_ptr(id) mcbsp_ptr[id];
|
#define id_to_mcbsp_ptr(id) mcbsp_ptr[id];
|
||||||
@ -60,31 +60,31 @@ static void omap_mcbsp_dump_reg(u8 id)
|
|||||||
|
|
||||||
dev_dbg(mcbsp->dev, "**** McBSP%d regs ****\n", mcbsp->id);
|
dev_dbg(mcbsp->dev, "**** McBSP%d regs ****\n", mcbsp->id);
|
||||||
dev_dbg(mcbsp->dev, "DRR2: 0x%04x\n",
|
dev_dbg(mcbsp->dev, "DRR2: 0x%04x\n",
|
||||||
OMAP_MCBSP_READ(mcbsp->io_base, DRR2));
|
MCBSP_READ(mcbsp, DRR2));
|
||||||
dev_dbg(mcbsp->dev, "DRR1: 0x%04x\n",
|
dev_dbg(mcbsp->dev, "DRR1: 0x%04x\n",
|
||||||
OMAP_MCBSP_READ(mcbsp->io_base, DRR1));
|
MCBSP_READ(mcbsp, DRR1));
|
||||||
dev_dbg(mcbsp->dev, "DXR2: 0x%04x\n",
|
dev_dbg(mcbsp->dev, "DXR2: 0x%04x\n",
|
||||||
OMAP_MCBSP_READ(mcbsp->io_base, DXR2));
|
MCBSP_READ(mcbsp, DXR2));
|
||||||
dev_dbg(mcbsp->dev, "DXR1: 0x%04x\n",
|
dev_dbg(mcbsp->dev, "DXR1: 0x%04x\n",
|
||||||
OMAP_MCBSP_READ(mcbsp->io_base, DXR1));
|
MCBSP_READ(mcbsp, DXR1));
|
||||||
dev_dbg(mcbsp->dev, "SPCR2: 0x%04x\n",
|
dev_dbg(mcbsp->dev, "SPCR2: 0x%04x\n",
|
||||||
OMAP_MCBSP_READ(mcbsp->io_base, SPCR2));
|
MCBSP_READ(mcbsp, SPCR2));
|
||||||
dev_dbg(mcbsp->dev, "SPCR1: 0x%04x\n",
|
dev_dbg(mcbsp->dev, "SPCR1: 0x%04x\n",
|
||||||
OMAP_MCBSP_READ(mcbsp->io_base, SPCR1));
|
MCBSP_READ(mcbsp, SPCR1));
|
||||||
dev_dbg(mcbsp->dev, "RCR2: 0x%04x\n",
|
dev_dbg(mcbsp->dev, "RCR2: 0x%04x\n",
|
||||||
OMAP_MCBSP_READ(mcbsp->io_base, RCR2));
|
MCBSP_READ(mcbsp, RCR2));
|
||||||
dev_dbg(mcbsp->dev, "RCR1: 0x%04x\n",
|
dev_dbg(mcbsp->dev, "RCR1: 0x%04x\n",
|
||||||
OMAP_MCBSP_READ(mcbsp->io_base, RCR1));
|
MCBSP_READ(mcbsp, RCR1));
|
||||||
dev_dbg(mcbsp->dev, "XCR2: 0x%04x\n",
|
dev_dbg(mcbsp->dev, "XCR2: 0x%04x\n",
|
||||||
OMAP_MCBSP_READ(mcbsp->io_base, XCR2));
|
MCBSP_READ(mcbsp, XCR2));
|
||||||
dev_dbg(mcbsp->dev, "XCR1: 0x%04x\n",
|
dev_dbg(mcbsp->dev, "XCR1: 0x%04x\n",
|
||||||
OMAP_MCBSP_READ(mcbsp->io_base, XCR1));
|
MCBSP_READ(mcbsp, XCR1));
|
||||||
dev_dbg(mcbsp->dev, "SRGR2: 0x%04x\n",
|
dev_dbg(mcbsp->dev, "SRGR2: 0x%04x\n",
|
||||||
OMAP_MCBSP_READ(mcbsp->io_base, SRGR2));
|
MCBSP_READ(mcbsp, SRGR2));
|
||||||
dev_dbg(mcbsp->dev, "SRGR1: 0x%04x\n",
|
dev_dbg(mcbsp->dev, "SRGR1: 0x%04x\n",
|
||||||
OMAP_MCBSP_READ(mcbsp->io_base, SRGR1));
|
MCBSP_READ(mcbsp, SRGR1));
|
||||||
dev_dbg(mcbsp->dev, "PCR0: 0x%04x\n",
|
dev_dbg(mcbsp->dev, "PCR0: 0x%04x\n",
|
||||||
OMAP_MCBSP_READ(mcbsp->io_base, PCR0));
|
MCBSP_READ(mcbsp, PCR0));
|
||||||
dev_dbg(mcbsp->dev, "***********************\n");
|
dev_dbg(mcbsp->dev, "***********************\n");
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -93,15 +93,14 @@ static irqreturn_t omap_mcbsp_tx_irq_handler(int irq, void *dev_id)
|
|||||||
struct omap_mcbsp *mcbsp_tx = dev_id;
|
struct omap_mcbsp *mcbsp_tx = dev_id;
|
||||||
u16 irqst_spcr2;
|
u16 irqst_spcr2;
|
||||||
|
|
||||||
irqst_spcr2 = OMAP_MCBSP_READ(mcbsp_tx->io_base, SPCR2);
|
irqst_spcr2 = MCBSP_READ(mcbsp_tx, SPCR2);
|
||||||
dev_dbg(mcbsp_tx->dev, "TX IRQ callback : 0x%x\n", irqst_spcr2);
|
dev_dbg(mcbsp_tx->dev, "TX IRQ callback : 0x%x\n", irqst_spcr2);
|
||||||
|
|
||||||
if (irqst_spcr2 & XSYNC_ERR) {
|
if (irqst_spcr2 & XSYNC_ERR) {
|
||||||
dev_err(mcbsp_tx->dev, "TX Frame Sync Error! : 0x%x\n",
|
dev_err(mcbsp_tx->dev, "TX Frame Sync Error! : 0x%x\n",
|
||||||
irqst_spcr2);
|
irqst_spcr2);
|
||||||
/* Writing zero to XSYNC_ERR clears the IRQ */
|
/* Writing zero to XSYNC_ERR clears the IRQ */
|
||||||
OMAP_MCBSP_WRITE(mcbsp_tx->io_base, SPCR2,
|
MCBSP_WRITE(mcbsp_tx, SPCR2, irqst_spcr2 & ~(XSYNC_ERR));
|
||||||
irqst_spcr2 & ~(XSYNC_ERR));
|
|
||||||
} else {
|
} else {
|
||||||
complete(&mcbsp_tx->tx_irq_completion);
|
complete(&mcbsp_tx->tx_irq_completion);
|
||||||
}
|
}
|
||||||
@ -114,15 +113,14 @@ static irqreturn_t omap_mcbsp_rx_irq_handler(int irq, void *dev_id)
|
|||||||
struct omap_mcbsp *mcbsp_rx = dev_id;
|
struct omap_mcbsp *mcbsp_rx = dev_id;
|
||||||
u16 irqst_spcr1;
|
u16 irqst_spcr1;
|
||||||
|
|
||||||
irqst_spcr1 = OMAP_MCBSP_READ(mcbsp_rx->io_base, SPCR1);
|
irqst_spcr1 = MCBSP_READ(mcbsp_rx, SPCR1);
|
||||||
dev_dbg(mcbsp_rx->dev, "RX IRQ callback : 0x%x\n", irqst_spcr1);
|
dev_dbg(mcbsp_rx->dev, "RX IRQ callback : 0x%x\n", irqst_spcr1);
|
||||||
|
|
||||||
if (irqst_spcr1 & RSYNC_ERR) {
|
if (irqst_spcr1 & RSYNC_ERR) {
|
||||||
dev_err(mcbsp_rx->dev, "RX Frame Sync Error! : 0x%x\n",
|
dev_err(mcbsp_rx->dev, "RX Frame Sync Error! : 0x%x\n",
|
||||||
irqst_spcr1);
|
irqst_spcr1);
|
||||||
/* Writing zero to RSYNC_ERR clears the IRQ */
|
/* Writing zero to RSYNC_ERR clears the IRQ */
|
||||||
OMAP_MCBSP_WRITE(mcbsp_rx->io_base, SPCR1,
|
MCBSP_WRITE(mcbsp_rx, SPCR1, irqst_spcr1 & ~(RSYNC_ERR));
|
||||||
irqst_spcr1 & ~(RSYNC_ERR));
|
|
||||||
} else {
|
} else {
|
||||||
complete(&mcbsp_rx->tx_irq_completion);
|
complete(&mcbsp_rx->tx_irq_completion);
|
||||||
}
|
}
|
||||||
@ -135,7 +133,7 @@ static void omap_mcbsp_tx_dma_callback(int lch, u16 ch_status, void *data)
|
|||||||
struct omap_mcbsp *mcbsp_dma_tx = data;
|
struct omap_mcbsp *mcbsp_dma_tx = data;
|
||||||
|
|
||||||
dev_dbg(mcbsp_dma_tx->dev, "TX DMA callback : 0x%x\n",
|
dev_dbg(mcbsp_dma_tx->dev, "TX DMA callback : 0x%x\n",
|
||||||
OMAP_MCBSP_READ(mcbsp_dma_tx->io_base, SPCR2));
|
MCBSP_READ(mcbsp_dma_tx, SPCR2));
|
||||||
|
|
||||||
/* We can free the channels */
|
/* We can free the channels */
|
||||||
omap_free_dma(mcbsp_dma_tx->dma_tx_lch);
|
omap_free_dma(mcbsp_dma_tx->dma_tx_lch);
|
||||||
@ -149,7 +147,7 @@ static void omap_mcbsp_rx_dma_callback(int lch, u16 ch_status, void *data)
|
|||||||
struct omap_mcbsp *mcbsp_dma_rx = data;
|
struct omap_mcbsp *mcbsp_dma_rx = data;
|
||||||
|
|
||||||
dev_dbg(mcbsp_dma_rx->dev, "RX DMA callback : 0x%x\n",
|
dev_dbg(mcbsp_dma_rx->dev, "RX DMA callback : 0x%x\n",
|
||||||
OMAP_MCBSP_READ(mcbsp_dma_rx->io_base, SPCR2));
|
MCBSP_READ(mcbsp_dma_rx, SPCR2));
|
||||||
|
|
||||||
/* We can free the channels */
|
/* We can free the channels */
|
||||||
omap_free_dma(mcbsp_dma_rx->dma_rx_lch);
|
omap_free_dma(mcbsp_dma_rx->dma_rx_lch);
|
||||||
@ -167,7 +165,6 @@ static void omap_mcbsp_rx_dma_callback(int lch, u16 ch_status, void *data)
|
|||||||
void omap_mcbsp_config(unsigned int id, const struct omap_mcbsp_reg_cfg *config)
|
void omap_mcbsp_config(unsigned int id, const struct omap_mcbsp_reg_cfg *config)
|
||||||
{
|
{
|
||||||
struct omap_mcbsp *mcbsp;
|
struct omap_mcbsp *mcbsp;
|
||||||
void __iomem *io_base;
|
|
||||||
|
|
||||||
if (!omap_mcbsp_check_valid_id(id)) {
|
if (!omap_mcbsp_check_valid_id(id)) {
|
||||||
printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
|
printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
|
||||||
@ -175,25 +172,24 @@ void omap_mcbsp_config(unsigned int id, const struct omap_mcbsp_reg_cfg *config)
|
|||||||
}
|
}
|
||||||
mcbsp = id_to_mcbsp_ptr(id);
|
mcbsp = id_to_mcbsp_ptr(id);
|
||||||
|
|
||||||
io_base = mcbsp->io_base;
|
|
||||||
dev_dbg(mcbsp->dev, "Configuring McBSP%d phys_base: 0x%08lx\n",
|
dev_dbg(mcbsp->dev, "Configuring McBSP%d phys_base: 0x%08lx\n",
|
||||||
mcbsp->id, mcbsp->phys_base);
|
mcbsp->id, mcbsp->phys_base);
|
||||||
|
|
||||||
/* We write the given config */
|
/* We write the given config */
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR2, config->spcr2);
|
MCBSP_WRITE(mcbsp, SPCR2, config->spcr2);
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR1, config->spcr1);
|
MCBSP_WRITE(mcbsp, SPCR1, config->spcr1);
|
||||||
OMAP_MCBSP_WRITE(io_base, RCR2, config->rcr2);
|
MCBSP_WRITE(mcbsp, RCR2, config->rcr2);
|
||||||
OMAP_MCBSP_WRITE(io_base, RCR1, config->rcr1);
|
MCBSP_WRITE(mcbsp, RCR1, config->rcr1);
|
||||||
OMAP_MCBSP_WRITE(io_base, XCR2, config->xcr2);
|
MCBSP_WRITE(mcbsp, XCR2, config->xcr2);
|
||||||
OMAP_MCBSP_WRITE(io_base, XCR1, config->xcr1);
|
MCBSP_WRITE(mcbsp, XCR1, config->xcr1);
|
||||||
OMAP_MCBSP_WRITE(io_base, SRGR2, config->srgr2);
|
MCBSP_WRITE(mcbsp, SRGR2, config->srgr2);
|
||||||
OMAP_MCBSP_WRITE(io_base, SRGR1, config->srgr1);
|
MCBSP_WRITE(mcbsp, SRGR1, config->srgr1);
|
||||||
OMAP_MCBSP_WRITE(io_base, MCR2, config->mcr2);
|
MCBSP_WRITE(mcbsp, MCR2, config->mcr2);
|
||||||
OMAP_MCBSP_WRITE(io_base, MCR1, config->mcr1);
|
MCBSP_WRITE(mcbsp, MCR1, config->mcr1);
|
||||||
OMAP_MCBSP_WRITE(io_base, PCR0, config->pcr0);
|
MCBSP_WRITE(mcbsp, PCR0, config->pcr0);
|
||||||
if (cpu_is_omap2430() || cpu_is_omap34xx() || cpu_is_omap44xx()) {
|
if (cpu_is_omap2430() || cpu_is_omap34xx() || cpu_is_omap44xx()) {
|
||||||
OMAP_MCBSP_WRITE(io_base, XCCR, config->xccr);
|
MCBSP_WRITE(mcbsp, XCCR, config->xccr);
|
||||||
OMAP_MCBSP_WRITE(io_base, RCCR, config->rccr);
|
MCBSP_WRITE(mcbsp, RCCR, config->rccr);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL(omap_mcbsp_config);
|
EXPORT_SYMBOL(omap_mcbsp_config);
|
||||||
@ -207,7 +203,6 @@ EXPORT_SYMBOL(omap_mcbsp_config);
|
|||||||
void omap_mcbsp_set_tx_threshold(unsigned int id, u16 threshold)
|
void omap_mcbsp_set_tx_threshold(unsigned int id, u16 threshold)
|
||||||
{
|
{
|
||||||
struct omap_mcbsp *mcbsp;
|
struct omap_mcbsp *mcbsp;
|
||||||
void __iomem *io_base;
|
|
||||||
|
|
||||||
if (!cpu_is_omap34xx())
|
if (!cpu_is_omap34xx())
|
||||||
return;
|
return;
|
||||||
@ -217,9 +212,8 @@ void omap_mcbsp_set_tx_threshold(unsigned int id, u16 threshold)
|
|||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
mcbsp = id_to_mcbsp_ptr(id);
|
mcbsp = id_to_mcbsp_ptr(id);
|
||||||
io_base = mcbsp->io_base;
|
|
||||||
|
|
||||||
OMAP_MCBSP_WRITE(io_base, THRSH2, threshold);
|
MCBSP_WRITE(mcbsp, THRSH2, threshold);
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL(omap_mcbsp_set_tx_threshold);
|
EXPORT_SYMBOL(omap_mcbsp_set_tx_threshold);
|
||||||
|
|
||||||
@ -231,7 +225,6 @@ EXPORT_SYMBOL(omap_mcbsp_set_tx_threshold);
|
|||||||
void omap_mcbsp_set_rx_threshold(unsigned int id, u16 threshold)
|
void omap_mcbsp_set_rx_threshold(unsigned int id, u16 threshold)
|
||||||
{
|
{
|
||||||
struct omap_mcbsp *mcbsp;
|
struct omap_mcbsp *mcbsp;
|
||||||
void __iomem *io_base;
|
|
||||||
|
|
||||||
if (!cpu_is_omap34xx())
|
if (!cpu_is_omap34xx())
|
||||||
return;
|
return;
|
||||||
@ -241,9 +234,8 @@ void omap_mcbsp_set_rx_threshold(unsigned int id, u16 threshold)
|
|||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
mcbsp = id_to_mcbsp_ptr(id);
|
mcbsp = id_to_mcbsp_ptr(id);
|
||||||
io_base = mcbsp->io_base;
|
|
||||||
|
|
||||||
OMAP_MCBSP_WRITE(io_base, THRSH1, threshold);
|
MCBSP_WRITE(mcbsp, THRSH1, threshold);
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL(omap_mcbsp_set_rx_threshold);
|
EXPORT_SYMBOL(omap_mcbsp_set_rx_threshold);
|
||||||
|
|
||||||
@ -313,19 +305,18 @@ static inline void omap34xx_mcbsp_request(struct omap_mcbsp *mcbsp)
|
|||||||
if (cpu_is_omap34xx()) {
|
if (cpu_is_omap34xx()) {
|
||||||
u16 syscon;
|
u16 syscon;
|
||||||
|
|
||||||
syscon = OMAP_MCBSP_READ(mcbsp->io_base, SYSCON);
|
syscon = MCBSP_READ(mcbsp, SYSCON);
|
||||||
syscon &= ~(ENAWAKEUP | SIDLEMODE(0x03) | CLOCKACTIVITY(0x03));
|
syscon &= ~(ENAWAKEUP | SIDLEMODE(0x03) | CLOCKACTIVITY(0x03));
|
||||||
|
|
||||||
if (mcbsp->dma_op_mode == MCBSP_DMA_MODE_THRESHOLD) {
|
if (mcbsp->dma_op_mode == MCBSP_DMA_MODE_THRESHOLD) {
|
||||||
syscon |= (ENAWAKEUP | SIDLEMODE(0x02) |
|
syscon |= (ENAWAKEUP | SIDLEMODE(0x02) |
|
||||||
CLOCKACTIVITY(0x02));
|
CLOCKACTIVITY(0x02));
|
||||||
OMAP_MCBSP_WRITE(mcbsp->io_base, WAKEUPEN,
|
MCBSP_WRITE(mcbsp, WAKEUPEN, XRDYEN | RRDYEN);
|
||||||
XRDYEN | RRDYEN);
|
|
||||||
} else {
|
} else {
|
||||||
syscon |= SIDLEMODE(0x01);
|
syscon |= SIDLEMODE(0x01);
|
||||||
}
|
}
|
||||||
|
|
||||||
OMAP_MCBSP_WRITE(mcbsp->io_base, SYSCON, syscon);
|
MCBSP_WRITE(mcbsp, SYSCON, syscon);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -337,7 +328,7 @@ static inline void omap34xx_mcbsp_free(struct omap_mcbsp *mcbsp)
|
|||||||
if (cpu_is_omap34xx()) {
|
if (cpu_is_omap34xx()) {
|
||||||
u16 syscon;
|
u16 syscon;
|
||||||
|
|
||||||
syscon = OMAP_MCBSP_READ(mcbsp->io_base, SYSCON);
|
syscon = MCBSP_READ(mcbsp, SYSCON);
|
||||||
syscon &= ~(ENAWAKEUP | SIDLEMODE(0x03) | CLOCKACTIVITY(0x03));
|
syscon &= ~(ENAWAKEUP | SIDLEMODE(0x03) | CLOCKACTIVITY(0x03));
|
||||||
/*
|
/*
|
||||||
* HW bug workaround - If no_idle mode is taken, we need to
|
* HW bug workaround - If no_idle mode is taken, we need to
|
||||||
@ -345,12 +336,12 @@ static inline void omap34xx_mcbsp_free(struct omap_mcbsp *mcbsp)
|
|||||||
* device will not hit retention anymore.
|
* device will not hit retention anymore.
|
||||||
*/
|
*/
|
||||||
syscon |= SIDLEMODE(0x02);
|
syscon |= SIDLEMODE(0x02);
|
||||||
OMAP_MCBSP_WRITE(mcbsp->io_base, SYSCON, syscon);
|
MCBSP_WRITE(mcbsp, SYSCON, syscon);
|
||||||
|
|
||||||
syscon &= ~(SIDLEMODE(0x03));
|
syscon &= ~(SIDLEMODE(0x03));
|
||||||
OMAP_MCBSP_WRITE(mcbsp->io_base, SYSCON, syscon);
|
MCBSP_WRITE(mcbsp, SYSCON, syscon);
|
||||||
|
|
||||||
OMAP_MCBSP_WRITE(mcbsp->io_base, WAKEUPEN, 0);
|
MCBSP_WRITE(mcbsp, WAKEUPEN, 0);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
#else
|
#else
|
||||||
@ -424,8 +415,8 @@ int omap_mcbsp_request(unsigned int id)
|
|||||||
* Make sure that transmitter, receiver and sample-rate generator are
|
* Make sure that transmitter, receiver and sample-rate generator are
|
||||||
* not running before activating IRQs.
|
* not running before activating IRQs.
|
||||||
*/
|
*/
|
||||||
OMAP_MCBSP_WRITE(mcbsp->io_base, SPCR1, 0);
|
MCBSP_WRITE(mcbsp, SPCR1, 0);
|
||||||
OMAP_MCBSP_WRITE(mcbsp->io_base, SPCR2, 0);
|
MCBSP_WRITE(mcbsp, SPCR2, 0);
|
||||||
|
|
||||||
if (mcbsp->io_type == OMAP_MCBSP_IRQ_IO) {
|
if (mcbsp->io_type == OMAP_MCBSP_IRQ_IO) {
|
||||||
/* We need to get IRQs here */
|
/* We need to get IRQs here */
|
||||||
@ -515,7 +506,6 @@ EXPORT_SYMBOL(omap_mcbsp_free);
|
|||||||
void omap_mcbsp_start(unsigned int id, int tx, int rx)
|
void omap_mcbsp_start(unsigned int id, int tx, int rx)
|
||||||
{
|
{
|
||||||
struct omap_mcbsp *mcbsp;
|
struct omap_mcbsp *mcbsp;
|
||||||
void __iomem *io_base;
|
|
||||||
int idle;
|
int idle;
|
||||||
u16 w;
|
u16 w;
|
||||||
|
|
||||||
@ -524,28 +514,26 @@ void omap_mcbsp_start(unsigned int id, int tx, int rx)
|
|||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
mcbsp = id_to_mcbsp_ptr(id);
|
mcbsp = id_to_mcbsp_ptr(id);
|
||||||
io_base = mcbsp->io_base;
|
|
||||||
|
|
||||||
mcbsp->rx_word_length = (OMAP_MCBSP_READ(io_base, RCR1) >> 5) & 0x7;
|
mcbsp->rx_word_length = (MCBSP_READ(mcbsp, RCR1) >> 5) & 0x7;
|
||||||
mcbsp->tx_word_length = (OMAP_MCBSP_READ(io_base, XCR1) >> 5) & 0x7;
|
mcbsp->tx_word_length = (MCBSP_READ(mcbsp, XCR1) >> 5) & 0x7;
|
||||||
|
|
||||||
idle = !((OMAP_MCBSP_READ(io_base, SPCR2) |
|
idle = !((MCBSP_READ(mcbsp, SPCR2) | MCBSP_READ(mcbsp, SPCR1)) & 1);
|
||||||
OMAP_MCBSP_READ(io_base, SPCR1)) & 1);
|
|
||||||
|
|
||||||
if (idle) {
|
if (idle) {
|
||||||
/* Start the sample generator */
|
/* Start the sample generator */
|
||||||
w = OMAP_MCBSP_READ(io_base, SPCR2);
|
w = MCBSP_READ(mcbsp, SPCR2);
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR2, w | (1 << 6));
|
MCBSP_WRITE(mcbsp, SPCR2, w | (1 << 6));
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Enable transmitter and receiver */
|
/* Enable transmitter and receiver */
|
||||||
tx &= 1;
|
tx &= 1;
|
||||||
w = OMAP_MCBSP_READ(io_base, SPCR2);
|
w = MCBSP_READ(mcbsp, SPCR2);
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR2, w | tx);
|
MCBSP_WRITE(mcbsp, SPCR2, w | tx);
|
||||||
|
|
||||||
rx &= 1;
|
rx &= 1;
|
||||||
w = OMAP_MCBSP_READ(io_base, SPCR1);
|
w = MCBSP_READ(mcbsp, SPCR1);
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR1, w | rx);
|
MCBSP_WRITE(mcbsp, SPCR1, w | rx);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Worst case: CLKSRG*2 = 8000khz: (1/8000) * 2 * 2 usec
|
* Worst case: CLKSRG*2 = 8000khz: (1/8000) * 2 * 2 usec
|
||||||
@ -557,18 +545,18 @@ void omap_mcbsp_start(unsigned int id, int tx, int rx)
|
|||||||
|
|
||||||
if (idle) {
|
if (idle) {
|
||||||
/* Start frame sync */
|
/* Start frame sync */
|
||||||
w = OMAP_MCBSP_READ(io_base, SPCR2);
|
w = MCBSP_READ(mcbsp, SPCR2);
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR2, w | (1 << 7));
|
MCBSP_WRITE(mcbsp, SPCR2, w | (1 << 7));
|
||||||
}
|
}
|
||||||
|
|
||||||
if (cpu_is_omap2430() || cpu_is_omap34xx()) {
|
if (cpu_is_omap2430() || cpu_is_omap34xx()) {
|
||||||
/* Release the transmitter and receiver */
|
/* Release the transmitter and receiver */
|
||||||
w = OMAP_MCBSP_READ(io_base, XCCR);
|
w = MCBSP_READ(mcbsp, XCCR);
|
||||||
w &= ~(tx ? XDISABLE : 0);
|
w &= ~(tx ? XDISABLE : 0);
|
||||||
OMAP_MCBSP_WRITE(io_base, XCCR, w);
|
MCBSP_WRITE(mcbsp, XCCR, w);
|
||||||
w = OMAP_MCBSP_READ(io_base, RCCR);
|
w = MCBSP_READ(mcbsp, RCCR);
|
||||||
w &= ~(rx ? RDISABLE : 0);
|
w &= ~(rx ? RDISABLE : 0);
|
||||||
OMAP_MCBSP_WRITE(io_base, RCCR, w);
|
MCBSP_WRITE(mcbsp, RCCR, w);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Dump McBSP Regs */
|
/* Dump McBSP Regs */
|
||||||
@ -579,7 +567,6 @@ EXPORT_SYMBOL(omap_mcbsp_start);
|
|||||||
void omap_mcbsp_stop(unsigned int id, int tx, int rx)
|
void omap_mcbsp_stop(unsigned int id, int tx, int rx)
|
||||||
{
|
{
|
||||||
struct omap_mcbsp *mcbsp;
|
struct omap_mcbsp *mcbsp;
|
||||||
void __iomem *io_base;
|
|
||||||
int idle;
|
int idle;
|
||||||
u16 w;
|
u16 w;
|
||||||
|
|
||||||
@ -589,35 +576,33 @@ void omap_mcbsp_stop(unsigned int id, int tx, int rx)
|
|||||||
}
|
}
|
||||||
|
|
||||||
mcbsp = id_to_mcbsp_ptr(id);
|
mcbsp = id_to_mcbsp_ptr(id);
|
||||||
io_base = mcbsp->io_base;
|
|
||||||
|
|
||||||
/* Reset transmitter */
|
/* Reset transmitter */
|
||||||
tx &= 1;
|
tx &= 1;
|
||||||
if (cpu_is_omap2430() || cpu_is_omap34xx()) {
|
if (cpu_is_omap2430() || cpu_is_omap34xx()) {
|
||||||
w = OMAP_MCBSP_READ(io_base, XCCR);
|
w = MCBSP_READ(mcbsp, XCCR);
|
||||||
w |= (tx ? XDISABLE : 0);
|
w |= (tx ? XDISABLE : 0);
|
||||||
OMAP_MCBSP_WRITE(io_base, XCCR, w);
|
MCBSP_WRITE(mcbsp, XCCR, w);
|
||||||
}
|
}
|
||||||
w = OMAP_MCBSP_READ(io_base, SPCR2);
|
w = MCBSP_READ(mcbsp, SPCR2);
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR2, w & ~tx);
|
MCBSP_WRITE(mcbsp, SPCR2, w & ~tx);
|
||||||
|
|
||||||
/* Reset receiver */
|
/* Reset receiver */
|
||||||
rx &= 1;
|
rx &= 1;
|
||||||
if (cpu_is_omap2430() || cpu_is_omap34xx()) {
|
if (cpu_is_omap2430() || cpu_is_omap34xx()) {
|
||||||
w = OMAP_MCBSP_READ(io_base, RCCR);
|
w = MCBSP_READ(mcbsp, RCCR);
|
||||||
w |= (rx ? RDISABLE : 0);
|
w |= (rx ? RDISABLE : 0);
|
||||||
OMAP_MCBSP_WRITE(io_base, RCCR, w);
|
MCBSP_WRITE(mcbsp, RCCR, w);
|
||||||
}
|
}
|
||||||
w = OMAP_MCBSP_READ(io_base, SPCR1);
|
w = MCBSP_READ(mcbsp, SPCR1);
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR1, w & ~rx);
|
MCBSP_WRITE(mcbsp, SPCR1, w & ~rx);
|
||||||
|
|
||||||
idle = !((OMAP_MCBSP_READ(io_base, SPCR2) |
|
idle = !((MCBSP_READ(mcbsp, SPCR2) | MCBSP_READ(mcbsp, SPCR1)) & 1);
|
||||||
OMAP_MCBSP_READ(io_base, SPCR1)) & 1);
|
|
||||||
|
|
||||||
if (idle) {
|
if (idle) {
|
||||||
/* Reset the sample rate generator */
|
/* Reset the sample rate generator */
|
||||||
w = OMAP_MCBSP_READ(io_base, SPCR2);
|
w = MCBSP_READ(mcbsp, SPCR2);
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR2, w & ~(1 << 6));
|
MCBSP_WRITE(mcbsp, SPCR2, w & ~(1 << 6));
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL(omap_mcbsp_stop);
|
EXPORT_SYMBOL(omap_mcbsp_stop);
|
||||||
@ -626,7 +611,6 @@ EXPORT_SYMBOL(omap_mcbsp_stop);
|
|||||||
int omap_mcbsp_pollwrite(unsigned int id, u16 buf)
|
int omap_mcbsp_pollwrite(unsigned int id, u16 buf)
|
||||||
{
|
{
|
||||||
struct omap_mcbsp *mcbsp;
|
struct omap_mcbsp *mcbsp;
|
||||||
void __iomem *base;
|
|
||||||
|
|
||||||
if (!omap_mcbsp_check_valid_id(id)) {
|
if (!omap_mcbsp_check_valid_id(id)) {
|
||||||
printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
|
printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
|
||||||
@ -634,28 +618,25 @@ int omap_mcbsp_pollwrite(unsigned int id, u16 buf)
|
|||||||
}
|
}
|
||||||
|
|
||||||
mcbsp = id_to_mcbsp_ptr(id);
|
mcbsp = id_to_mcbsp_ptr(id);
|
||||||
base = mcbsp->io_base;
|
|
||||||
|
|
||||||
OMAP_MCBSP_WRITE(base, DXR1, buf);
|
MCBSP_WRITE(mcbsp, DXR1, buf);
|
||||||
/* if frame sync error - clear the error */
|
/* if frame sync error - clear the error */
|
||||||
if (OMAP_MCBSP_READ(base, SPCR2) & XSYNC_ERR) {
|
if (MCBSP_READ(mcbsp, SPCR2) & XSYNC_ERR) {
|
||||||
/* clear error */
|
/* clear error */
|
||||||
OMAP_MCBSP_WRITE(base, SPCR2,
|
MCBSP_WRITE(mcbsp, SPCR2,
|
||||||
OMAP_MCBSP_READ(base, SPCR2) & (~XSYNC_ERR));
|
MCBSP_READ(mcbsp, SPCR2) & (~XSYNC_ERR));
|
||||||
/* resend */
|
/* resend */
|
||||||
return -1;
|
return -1;
|
||||||
} else {
|
} else {
|
||||||
/* wait for transmit confirmation */
|
/* wait for transmit confirmation */
|
||||||
int attemps = 0;
|
int attemps = 0;
|
||||||
while (!(OMAP_MCBSP_READ(base, SPCR2) & XRDY)) {
|
while (!(MCBSP_READ(mcbsp, SPCR2) & XRDY)) {
|
||||||
if (attemps++ > 1000) {
|
if (attemps++ > 1000) {
|
||||||
OMAP_MCBSP_WRITE(base, SPCR2,
|
MCBSP_WRITE(mcbsp, SPCR2,
|
||||||
OMAP_MCBSP_READ(base, SPCR2) &
|
MCBSP_READ(mcbsp, SPCR2) & (~XRST));
|
||||||
(~XRST));
|
|
||||||
udelay(10);
|
udelay(10);
|
||||||
OMAP_MCBSP_WRITE(base, SPCR2,
|
MCBSP_WRITE(mcbsp, SPCR2,
|
||||||
OMAP_MCBSP_READ(base, SPCR2) |
|
MCBSP_READ(mcbsp, SPCR2) | (XRST));
|
||||||
(XRST));
|
|
||||||
udelay(10);
|
udelay(10);
|
||||||
dev_err(mcbsp->dev, "Could not write to"
|
dev_err(mcbsp->dev, "Could not write to"
|
||||||
" McBSP%d Register\n", mcbsp->id);
|
" McBSP%d Register\n", mcbsp->id);
|
||||||
@ -671,7 +652,6 @@ EXPORT_SYMBOL(omap_mcbsp_pollwrite);
|
|||||||
int omap_mcbsp_pollread(unsigned int id, u16 *buf)
|
int omap_mcbsp_pollread(unsigned int id, u16 *buf)
|
||||||
{
|
{
|
||||||
struct omap_mcbsp *mcbsp;
|
struct omap_mcbsp *mcbsp;
|
||||||
void __iomem *base;
|
|
||||||
|
|
||||||
if (!omap_mcbsp_check_valid_id(id)) {
|
if (!omap_mcbsp_check_valid_id(id)) {
|
||||||
printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
|
printk(KERN_ERR "%s: Invalid id (%d)\n", __func__, id + 1);
|
||||||
@ -679,26 +659,23 @@ int omap_mcbsp_pollread(unsigned int id, u16 *buf)
|
|||||||
}
|
}
|
||||||
mcbsp = id_to_mcbsp_ptr(id);
|
mcbsp = id_to_mcbsp_ptr(id);
|
||||||
|
|
||||||
base = mcbsp->io_base;
|
|
||||||
/* if frame sync error - clear the error */
|
/* if frame sync error - clear the error */
|
||||||
if (OMAP_MCBSP_READ(base, SPCR1) & RSYNC_ERR) {
|
if (MCBSP_READ(mcbsp, SPCR1) & RSYNC_ERR) {
|
||||||
/* clear error */
|
/* clear error */
|
||||||
OMAP_MCBSP_WRITE(base, SPCR1,
|
MCBSP_WRITE(mcbsp, SPCR1,
|
||||||
OMAP_MCBSP_READ(base, SPCR1) & (~RSYNC_ERR));
|
MCBSP_READ(mcbsp, SPCR1) & (~RSYNC_ERR));
|
||||||
/* resend */
|
/* resend */
|
||||||
return -1;
|
return -1;
|
||||||
} else {
|
} else {
|
||||||
/* wait for recieve confirmation */
|
/* wait for recieve confirmation */
|
||||||
int attemps = 0;
|
int attemps = 0;
|
||||||
while (!(OMAP_MCBSP_READ(base, SPCR1) & RRDY)) {
|
while (!(MCBSP_READ(mcbsp, SPCR1) & RRDY)) {
|
||||||
if (attemps++ > 1000) {
|
if (attemps++ > 1000) {
|
||||||
OMAP_MCBSP_WRITE(base, SPCR1,
|
MCBSP_WRITE(mcbsp, SPCR1,
|
||||||
OMAP_MCBSP_READ(base, SPCR1) &
|
MCBSP_READ(mcbsp, SPCR1) & (~RRST));
|
||||||
(~RRST));
|
|
||||||
udelay(10);
|
udelay(10);
|
||||||
OMAP_MCBSP_WRITE(base, SPCR1,
|
MCBSP_WRITE(mcbsp, SPCR1,
|
||||||
OMAP_MCBSP_READ(base, SPCR1) |
|
MCBSP_READ(mcbsp, SPCR1) | (RRST));
|
||||||
(RRST));
|
|
||||||
udelay(10);
|
udelay(10);
|
||||||
dev_err(mcbsp->dev, "Could not read from"
|
dev_err(mcbsp->dev, "Could not read from"
|
||||||
" McBSP%d Register\n", mcbsp->id);
|
" McBSP%d Register\n", mcbsp->id);
|
||||||
@ -706,7 +683,7 @@ int omap_mcbsp_pollread(unsigned int id, u16 *buf)
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
*buf = OMAP_MCBSP_READ(base, DRR1);
|
*buf = MCBSP_READ(mcbsp, DRR1);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
@ -718,7 +695,6 @@ EXPORT_SYMBOL(omap_mcbsp_pollread);
|
|||||||
void omap_mcbsp_xmit_word(unsigned int id, u32 word)
|
void omap_mcbsp_xmit_word(unsigned int id, u32 word)
|
||||||
{
|
{
|
||||||
struct omap_mcbsp *mcbsp;
|
struct omap_mcbsp *mcbsp;
|
||||||
void __iomem *io_base;
|
|
||||||
omap_mcbsp_word_length word_length;
|
omap_mcbsp_word_length word_length;
|
||||||
|
|
||||||
if (!omap_mcbsp_check_valid_id(id)) {
|
if (!omap_mcbsp_check_valid_id(id)) {
|
||||||
@ -727,21 +703,19 @@ void omap_mcbsp_xmit_word(unsigned int id, u32 word)
|
|||||||
}
|
}
|
||||||
|
|
||||||
mcbsp = id_to_mcbsp_ptr(id);
|
mcbsp = id_to_mcbsp_ptr(id);
|
||||||
io_base = mcbsp->io_base;
|
|
||||||
word_length = mcbsp->tx_word_length;
|
word_length = mcbsp->tx_word_length;
|
||||||
|
|
||||||
wait_for_completion(&mcbsp->tx_irq_completion);
|
wait_for_completion(&mcbsp->tx_irq_completion);
|
||||||
|
|
||||||
if (word_length > OMAP_MCBSP_WORD_16)
|
if (word_length > OMAP_MCBSP_WORD_16)
|
||||||
OMAP_MCBSP_WRITE(io_base, DXR2, word >> 16);
|
MCBSP_WRITE(mcbsp, DXR2, word >> 16);
|
||||||
OMAP_MCBSP_WRITE(io_base, DXR1, word & 0xffff);
|
MCBSP_WRITE(mcbsp, DXR1, word & 0xffff);
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL(omap_mcbsp_xmit_word);
|
EXPORT_SYMBOL(omap_mcbsp_xmit_word);
|
||||||
|
|
||||||
u32 omap_mcbsp_recv_word(unsigned int id)
|
u32 omap_mcbsp_recv_word(unsigned int id)
|
||||||
{
|
{
|
||||||
struct omap_mcbsp *mcbsp;
|
struct omap_mcbsp *mcbsp;
|
||||||
void __iomem *io_base;
|
|
||||||
u16 word_lsb, word_msb = 0;
|
u16 word_lsb, word_msb = 0;
|
||||||
omap_mcbsp_word_length word_length;
|
omap_mcbsp_word_length word_length;
|
||||||
|
|
||||||
@ -752,13 +726,12 @@ u32 omap_mcbsp_recv_word(unsigned int id)
|
|||||||
mcbsp = id_to_mcbsp_ptr(id);
|
mcbsp = id_to_mcbsp_ptr(id);
|
||||||
|
|
||||||
word_length = mcbsp->rx_word_length;
|
word_length = mcbsp->rx_word_length;
|
||||||
io_base = mcbsp->io_base;
|
|
||||||
|
|
||||||
wait_for_completion(&mcbsp->rx_irq_completion);
|
wait_for_completion(&mcbsp->rx_irq_completion);
|
||||||
|
|
||||||
if (word_length > OMAP_MCBSP_WORD_16)
|
if (word_length > OMAP_MCBSP_WORD_16)
|
||||||
word_msb = OMAP_MCBSP_READ(io_base, DRR2);
|
word_msb = MCBSP_READ(mcbsp, DRR2);
|
||||||
word_lsb = OMAP_MCBSP_READ(io_base, DRR1);
|
word_lsb = MCBSP_READ(mcbsp, DRR1);
|
||||||
|
|
||||||
return (word_lsb | (word_msb << 16));
|
return (word_lsb | (word_msb << 16));
|
||||||
}
|
}
|
||||||
@ -767,7 +740,6 @@ EXPORT_SYMBOL(omap_mcbsp_recv_word);
|
|||||||
int omap_mcbsp_spi_master_xmit_word_poll(unsigned int id, u32 word)
|
int omap_mcbsp_spi_master_xmit_word_poll(unsigned int id, u32 word)
|
||||||
{
|
{
|
||||||
struct omap_mcbsp *mcbsp;
|
struct omap_mcbsp *mcbsp;
|
||||||
void __iomem *io_base;
|
|
||||||
omap_mcbsp_word_length tx_word_length;
|
omap_mcbsp_word_length tx_word_length;
|
||||||
omap_mcbsp_word_length rx_word_length;
|
omap_mcbsp_word_length rx_word_length;
|
||||||
u16 spcr2, spcr1, attempts = 0, word_lsb, word_msb = 0;
|
u16 spcr2, spcr1, attempts = 0, word_lsb, word_msb = 0;
|
||||||
@ -777,7 +749,6 @@ int omap_mcbsp_spi_master_xmit_word_poll(unsigned int id, u32 word)
|
|||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
mcbsp = id_to_mcbsp_ptr(id);
|
mcbsp = id_to_mcbsp_ptr(id);
|
||||||
io_base = mcbsp->io_base;
|
|
||||||
tx_word_length = mcbsp->tx_word_length;
|
tx_word_length = mcbsp->tx_word_length;
|
||||||
rx_word_length = mcbsp->rx_word_length;
|
rx_word_length = mcbsp->rx_word_length;
|
||||||
|
|
||||||
@ -785,14 +756,14 @@ int omap_mcbsp_spi_master_xmit_word_poll(unsigned int id, u32 word)
|
|||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
|
||||||
/* First we wait for the transmitter to be ready */
|
/* First we wait for the transmitter to be ready */
|
||||||
spcr2 = OMAP_MCBSP_READ(io_base, SPCR2);
|
spcr2 = MCBSP_READ(mcbsp, SPCR2);
|
||||||
while (!(spcr2 & XRDY)) {
|
while (!(spcr2 & XRDY)) {
|
||||||
spcr2 = OMAP_MCBSP_READ(io_base, SPCR2);
|
spcr2 = MCBSP_READ(mcbsp, SPCR2);
|
||||||
if (attempts++ > 1000) {
|
if (attempts++ > 1000) {
|
||||||
/* We must reset the transmitter */
|
/* We must reset the transmitter */
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR2, spcr2 & (~XRST));
|
MCBSP_WRITE(mcbsp, SPCR2, spcr2 & (~XRST));
|
||||||
udelay(10);
|
udelay(10);
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR2, spcr2 | XRST);
|
MCBSP_WRITE(mcbsp, SPCR2, spcr2 | XRST);
|
||||||
udelay(10);
|
udelay(10);
|
||||||
dev_err(mcbsp->dev, "McBSP%d transmitter not "
|
dev_err(mcbsp->dev, "McBSP%d transmitter not "
|
||||||
"ready\n", mcbsp->id);
|
"ready\n", mcbsp->id);
|
||||||
@ -802,18 +773,18 @@ int omap_mcbsp_spi_master_xmit_word_poll(unsigned int id, u32 word)
|
|||||||
|
|
||||||
/* Now we can push the data */
|
/* Now we can push the data */
|
||||||
if (tx_word_length > OMAP_MCBSP_WORD_16)
|
if (tx_word_length > OMAP_MCBSP_WORD_16)
|
||||||
OMAP_MCBSP_WRITE(io_base, DXR2, word >> 16);
|
MCBSP_WRITE(mcbsp, DXR2, word >> 16);
|
||||||
OMAP_MCBSP_WRITE(io_base, DXR1, word & 0xffff);
|
MCBSP_WRITE(mcbsp, DXR1, word & 0xffff);
|
||||||
|
|
||||||
/* We wait for the receiver to be ready */
|
/* We wait for the receiver to be ready */
|
||||||
spcr1 = OMAP_MCBSP_READ(io_base, SPCR1);
|
spcr1 = MCBSP_READ(mcbsp, SPCR1);
|
||||||
while (!(spcr1 & RRDY)) {
|
while (!(spcr1 & RRDY)) {
|
||||||
spcr1 = OMAP_MCBSP_READ(io_base, SPCR1);
|
spcr1 = MCBSP_READ(mcbsp, SPCR1);
|
||||||
if (attempts++ > 1000) {
|
if (attempts++ > 1000) {
|
||||||
/* We must reset the receiver */
|
/* We must reset the receiver */
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR1, spcr1 & (~RRST));
|
MCBSP_WRITE(mcbsp, SPCR1, spcr1 & (~RRST));
|
||||||
udelay(10);
|
udelay(10);
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR1, spcr1 | RRST);
|
MCBSP_WRITE(mcbsp, SPCR1, spcr1 | RRST);
|
||||||
udelay(10);
|
udelay(10);
|
||||||
dev_err(mcbsp->dev, "McBSP%d receiver not "
|
dev_err(mcbsp->dev, "McBSP%d receiver not "
|
||||||
"ready\n", mcbsp->id);
|
"ready\n", mcbsp->id);
|
||||||
@ -823,8 +794,8 @@ int omap_mcbsp_spi_master_xmit_word_poll(unsigned int id, u32 word)
|
|||||||
|
|
||||||
/* Receiver is ready, let's read the dummy data */
|
/* Receiver is ready, let's read the dummy data */
|
||||||
if (rx_word_length > OMAP_MCBSP_WORD_16)
|
if (rx_word_length > OMAP_MCBSP_WORD_16)
|
||||||
word_msb = OMAP_MCBSP_READ(io_base, DRR2);
|
word_msb = MCBSP_READ(mcbsp, DRR2);
|
||||||
word_lsb = OMAP_MCBSP_READ(io_base, DRR1);
|
word_lsb = MCBSP_READ(mcbsp, DRR1);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
@ -834,7 +805,6 @@ int omap_mcbsp_spi_master_recv_word_poll(unsigned int id, u32 *word)
|
|||||||
{
|
{
|
||||||
struct omap_mcbsp *mcbsp;
|
struct omap_mcbsp *mcbsp;
|
||||||
u32 clock_word = 0;
|
u32 clock_word = 0;
|
||||||
void __iomem *io_base;
|
|
||||||
omap_mcbsp_word_length tx_word_length;
|
omap_mcbsp_word_length tx_word_length;
|
||||||
omap_mcbsp_word_length rx_word_length;
|
omap_mcbsp_word_length rx_word_length;
|
||||||
u16 spcr2, spcr1, attempts = 0, word_lsb, word_msb = 0;
|
u16 spcr2, spcr1, attempts = 0, word_lsb, word_msb = 0;
|
||||||
@ -845,7 +815,6 @@ int omap_mcbsp_spi_master_recv_word_poll(unsigned int id, u32 *word)
|
|||||||
}
|
}
|
||||||
|
|
||||||
mcbsp = id_to_mcbsp_ptr(id);
|
mcbsp = id_to_mcbsp_ptr(id);
|
||||||
io_base = mcbsp->io_base;
|
|
||||||
|
|
||||||
tx_word_length = mcbsp->tx_word_length;
|
tx_word_length = mcbsp->tx_word_length;
|
||||||
rx_word_length = mcbsp->rx_word_length;
|
rx_word_length = mcbsp->rx_word_length;
|
||||||
@ -854,14 +823,14 @@ int omap_mcbsp_spi_master_recv_word_poll(unsigned int id, u32 *word)
|
|||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
|
||||||
/* First we wait for the transmitter to be ready */
|
/* First we wait for the transmitter to be ready */
|
||||||
spcr2 = OMAP_MCBSP_READ(io_base, SPCR2);
|
spcr2 = MCBSP_READ(mcbsp, SPCR2);
|
||||||
while (!(spcr2 & XRDY)) {
|
while (!(spcr2 & XRDY)) {
|
||||||
spcr2 = OMAP_MCBSP_READ(io_base, SPCR2);
|
spcr2 = MCBSP_READ(mcbsp, SPCR2);
|
||||||
if (attempts++ > 1000) {
|
if (attempts++ > 1000) {
|
||||||
/* We must reset the transmitter */
|
/* We must reset the transmitter */
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR2, spcr2 & (~XRST));
|
MCBSP_WRITE(mcbsp, SPCR2, spcr2 & (~XRST));
|
||||||
udelay(10);
|
udelay(10);
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR2, spcr2 | XRST);
|
MCBSP_WRITE(mcbsp, SPCR2, spcr2 | XRST);
|
||||||
udelay(10);
|
udelay(10);
|
||||||
dev_err(mcbsp->dev, "McBSP%d transmitter not "
|
dev_err(mcbsp->dev, "McBSP%d transmitter not "
|
||||||
"ready\n", mcbsp->id);
|
"ready\n", mcbsp->id);
|
||||||
@ -871,18 +840,18 @@ int omap_mcbsp_spi_master_recv_word_poll(unsigned int id, u32 *word)
|
|||||||
|
|
||||||
/* We first need to enable the bus clock */
|
/* We first need to enable the bus clock */
|
||||||
if (tx_word_length > OMAP_MCBSP_WORD_16)
|
if (tx_word_length > OMAP_MCBSP_WORD_16)
|
||||||
OMAP_MCBSP_WRITE(io_base, DXR2, clock_word >> 16);
|
MCBSP_WRITE(mcbsp, DXR2, clock_word >> 16);
|
||||||
OMAP_MCBSP_WRITE(io_base, DXR1, clock_word & 0xffff);
|
MCBSP_WRITE(mcbsp, DXR1, clock_word & 0xffff);
|
||||||
|
|
||||||
/* We wait for the receiver to be ready */
|
/* We wait for the receiver to be ready */
|
||||||
spcr1 = OMAP_MCBSP_READ(io_base, SPCR1);
|
spcr1 = MCBSP_READ(mcbsp, SPCR1);
|
||||||
while (!(spcr1 & RRDY)) {
|
while (!(spcr1 & RRDY)) {
|
||||||
spcr1 = OMAP_MCBSP_READ(io_base, SPCR1);
|
spcr1 = MCBSP_READ(mcbsp, SPCR1);
|
||||||
if (attempts++ > 1000) {
|
if (attempts++ > 1000) {
|
||||||
/* We must reset the receiver */
|
/* We must reset the receiver */
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR1, spcr1 & (~RRST));
|
MCBSP_WRITE(mcbsp, SPCR1, spcr1 & (~RRST));
|
||||||
udelay(10);
|
udelay(10);
|
||||||
OMAP_MCBSP_WRITE(io_base, SPCR1, spcr1 | RRST);
|
MCBSP_WRITE(mcbsp, SPCR1, spcr1 | RRST);
|
||||||
udelay(10);
|
udelay(10);
|
||||||
dev_err(mcbsp->dev, "McBSP%d receiver not "
|
dev_err(mcbsp->dev, "McBSP%d receiver not "
|
||||||
"ready\n", mcbsp->id);
|
"ready\n", mcbsp->id);
|
||||||
@ -892,8 +861,8 @@ int omap_mcbsp_spi_master_recv_word_poll(unsigned int id, u32 *word)
|
|||||||
|
|
||||||
/* Receiver is ready, there is something for us */
|
/* Receiver is ready, there is something for us */
|
||||||
if (rx_word_length > OMAP_MCBSP_WORD_16)
|
if (rx_word_length > OMAP_MCBSP_WORD_16)
|
||||||
word_msb = OMAP_MCBSP_READ(io_base, DRR2);
|
word_msb = MCBSP_READ(mcbsp, DRR2);
|
||||||
word_lsb = OMAP_MCBSP_READ(io_base, DRR1);
|
word_lsb = MCBSP_READ(mcbsp, DRR1);
|
||||||
|
|
||||||
word[0] = (word_lsb | (word_msb << 16));
|
word[0] = (word_lsb | (word_msb << 16));
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user