forked from Minki/linux
ff0fba0bca
Fix the mailbox detection for OMAP3630 and 2430, also minor cleanup on conditional ifdef's that could affect it. Given that 2430 has an iva too, include it, as the same steps for omap3 apply. Signed-off-by: Omar Ramirez Luna <omar.ramirez@ti.com> Acked-by: Hiroshi Doyu <hiroshi.doyu@nokia.com>
476 lines
11 KiB
C
476 lines
11 KiB
C
/*
|
|
* Mailbox reservation modules for OMAP2/3
|
|
*
|
|
* Copyright (C) 2006-2009 Nokia Corporation
|
|
* Written by: Hiroshi DOYU <Hiroshi.DOYU@nokia.com>
|
|
* and Paul Mundt
|
|
*
|
|
* This file is subject to the terms and conditions of the GNU General Public
|
|
* License. See the file "COPYING" in the main directory of this archive
|
|
* for more details.
|
|
*/
|
|
|
|
#include <linux/clk.h>
|
|
#include <linux/err.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/io.h>
|
|
#include <plat/mailbox.h>
|
|
#include <mach/irqs.h>
|
|
|
|
#define MAILBOX_REVISION 0x000
|
|
#define MAILBOX_SYSCONFIG 0x010
|
|
#define MAILBOX_SYSSTATUS 0x014
|
|
#define MAILBOX_MESSAGE(m) (0x040 + 4 * (m))
|
|
#define MAILBOX_FIFOSTATUS(m) (0x080 + 4 * (m))
|
|
#define MAILBOX_MSGSTATUS(m) (0x0c0 + 4 * (m))
|
|
#define MAILBOX_IRQSTATUS(u) (0x100 + 8 * (u))
|
|
#define MAILBOX_IRQENABLE(u) (0x104 + 8 * (u))
|
|
|
|
#define OMAP4_MAILBOX_IRQSTATUS(u) (0x104 + 10 * (u))
|
|
#define OMAP4_MAILBOX_IRQENABLE(u) (0x108 + 10 * (u))
|
|
#define OMAP4_MAILBOX_IRQENABLE_CLR(u) (0x10c + 10 * (u))
|
|
|
|
#define MAILBOX_IRQ_NEWMSG(m) (1 << (2 * (m)))
|
|
#define MAILBOX_IRQ_NOTFULL(m) (1 << (2 * (m) + 1))
|
|
|
|
/* SYSCONFIG: register bit definition */
|
|
#define AUTOIDLE (1 << 0)
|
|
#define SOFTRESET (1 << 1)
|
|
#define SMARTIDLE (2 << 3)
|
|
#define OMAP4_SOFTRESET (1 << 0)
|
|
#define OMAP4_NOIDLE (1 << 2)
|
|
#define OMAP4_SMARTIDLE (2 << 2)
|
|
|
|
/* SYSSTATUS: register bit definition */
|
|
#define RESETDONE (1 << 0)
|
|
|
|
#define MBOX_REG_SIZE 0x120
|
|
|
|
#define OMAP4_MBOX_REG_SIZE 0x130
|
|
|
|
#define MBOX_NR_REGS (MBOX_REG_SIZE / sizeof(u32))
|
|
#define OMAP4_MBOX_NR_REGS (OMAP4_MBOX_REG_SIZE / sizeof(u32))
|
|
|
|
static void __iomem *mbox_base;
|
|
|
|
struct omap_mbox2_fifo {
|
|
unsigned long msg;
|
|
unsigned long fifo_stat;
|
|
unsigned long msg_stat;
|
|
};
|
|
|
|
struct omap_mbox2_priv {
|
|
struct omap_mbox2_fifo tx_fifo;
|
|
struct omap_mbox2_fifo rx_fifo;
|
|
unsigned long irqenable;
|
|
unsigned long irqstatus;
|
|
u32 newmsg_bit;
|
|
u32 notfull_bit;
|
|
u32 ctx[OMAP4_MBOX_NR_REGS];
|
|
unsigned long irqdisable;
|
|
};
|
|
|
|
static struct clk *mbox_ick_handle;
|
|
|
|
static void omap2_mbox_enable_irq(struct omap_mbox *mbox,
|
|
omap_mbox_type_t irq);
|
|
|
|
static inline unsigned int mbox_read_reg(size_t ofs)
|
|
{
|
|
return __raw_readl(mbox_base + ofs);
|
|
}
|
|
|
|
static inline void mbox_write_reg(u32 val, size_t ofs)
|
|
{
|
|
__raw_writel(val, mbox_base + ofs);
|
|
}
|
|
|
|
/* Mailbox H/W preparations */
|
|
static int omap2_mbox_startup(struct omap_mbox *mbox)
|
|
{
|
|
u32 l;
|
|
unsigned long timeout;
|
|
|
|
mbox_ick_handle = clk_get(NULL, "mailboxes_ick");
|
|
if (IS_ERR(mbox_ick_handle)) {
|
|
printk(KERN_ERR "Could not get mailboxes_ick: %ld\n",
|
|
PTR_ERR(mbox_ick_handle));
|
|
return PTR_ERR(mbox_ick_handle);
|
|
}
|
|
clk_enable(mbox_ick_handle);
|
|
|
|
if (cpu_is_omap44xx()) {
|
|
mbox_write_reg(OMAP4_SOFTRESET, MAILBOX_SYSCONFIG);
|
|
timeout = jiffies + msecs_to_jiffies(20);
|
|
do {
|
|
l = mbox_read_reg(MAILBOX_SYSCONFIG);
|
|
if (!(l & OMAP4_SOFTRESET))
|
|
break;
|
|
} while (!time_after(jiffies, timeout));
|
|
|
|
if (l & OMAP4_SOFTRESET) {
|
|
pr_err("Can't take mailbox out of reset\n");
|
|
return -ENODEV;
|
|
}
|
|
} else {
|
|
mbox_write_reg(SOFTRESET, MAILBOX_SYSCONFIG);
|
|
timeout = jiffies + msecs_to_jiffies(20);
|
|
do {
|
|
l = mbox_read_reg(MAILBOX_SYSSTATUS);
|
|
if (l & RESETDONE)
|
|
break;
|
|
} while (!time_after(jiffies, timeout));
|
|
|
|
if (!(l & RESETDONE)) {
|
|
pr_err("Can't take mailbox out of reset\n");
|
|
return -ENODEV;
|
|
}
|
|
}
|
|
|
|
l = mbox_read_reg(MAILBOX_REVISION);
|
|
pr_debug("omap mailbox rev %d.%d\n", (l & 0xf0) >> 4, (l & 0x0f));
|
|
|
|
if (cpu_is_omap44xx())
|
|
l = OMAP4_SMARTIDLE;
|
|
else
|
|
l = SMARTIDLE | AUTOIDLE;
|
|
mbox_write_reg(l, MAILBOX_SYSCONFIG);
|
|
|
|
omap2_mbox_enable_irq(mbox, IRQ_RX);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void omap2_mbox_shutdown(struct omap_mbox *mbox)
|
|
{
|
|
clk_disable(mbox_ick_handle);
|
|
clk_put(mbox_ick_handle);
|
|
mbox_ick_handle = NULL;
|
|
}
|
|
|
|
/* Mailbox FIFO handle functions */
|
|
static mbox_msg_t omap2_mbox_fifo_read(struct omap_mbox *mbox)
|
|
{
|
|
struct omap_mbox2_fifo *fifo =
|
|
&((struct omap_mbox2_priv *)mbox->priv)->rx_fifo;
|
|
return (mbox_msg_t) mbox_read_reg(fifo->msg);
|
|
}
|
|
|
|
static void omap2_mbox_fifo_write(struct omap_mbox *mbox, mbox_msg_t msg)
|
|
{
|
|
struct omap_mbox2_fifo *fifo =
|
|
&((struct omap_mbox2_priv *)mbox->priv)->tx_fifo;
|
|
mbox_write_reg(msg, fifo->msg);
|
|
}
|
|
|
|
static int omap2_mbox_fifo_empty(struct omap_mbox *mbox)
|
|
{
|
|
struct omap_mbox2_fifo *fifo =
|
|
&((struct omap_mbox2_priv *)mbox->priv)->rx_fifo;
|
|
return (mbox_read_reg(fifo->msg_stat) == 0);
|
|
}
|
|
|
|
static int omap2_mbox_fifo_full(struct omap_mbox *mbox)
|
|
{
|
|
struct omap_mbox2_fifo *fifo =
|
|
&((struct omap_mbox2_priv *)mbox->priv)->tx_fifo;
|
|
return mbox_read_reg(fifo->fifo_stat);
|
|
}
|
|
|
|
/* Mailbox IRQ handle functions */
|
|
static void omap2_mbox_enable_irq(struct omap_mbox *mbox,
|
|
omap_mbox_type_t irq)
|
|
{
|
|
struct omap_mbox2_priv *p = mbox->priv;
|
|
u32 l, bit = (irq == IRQ_TX) ? p->notfull_bit : p->newmsg_bit;
|
|
|
|
l = mbox_read_reg(p->irqenable);
|
|
l |= bit;
|
|
mbox_write_reg(l, p->irqenable);
|
|
}
|
|
|
|
static void omap2_mbox_disable_irq(struct omap_mbox *mbox,
|
|
omap_mbox_type_t irq)
|
|
{
|
|
struct omap_mbox2_priv *p = mbox->priv;
|
|
u32 l, bit = (irq == IRQ_TX) ? p->notfull_bit : p->newmsg_bit;
|
|
l = mbox_read_reg(p->irqdisable);
|
|
l &= ~bit;
|
|
mbox_write_reg(l, p->irqdisable);
|
|
}
|
|
|
|
static void omap2_mbox_ack_irq(struct omap_mbox *mbox,
|
|
omap_mbox_type_t irq)
|
|
{
|
|
struct omap_mbox2_priv *p = mbox->priv;
|
|
u32 bit = (irq == IRQ_TX) ? p->notfull_bit : p->newmsg_bit;
|
|
|
|
mbox_write_reg(bit, p->irqstatus);
|
|
|
|
/* Flush posted write for irq status to avoid spurious interrupts */
|
|
mbox_read_reg(p->irqstatus);
|
|
}
|
|
|
|
static int omap2_mbox_is_irq(struct omap_mbox *mbox,
|
|
omap_mbox_type_t irq)
|
|
{
|
|
struct omap_mbox2_priv *p = mbox->priv;
|
|
u32 bit = (irq == IRQ_TX) ? p->notfull_bit : p->newmsg_bit;
|
|
u32 enable = mbox_read_reg(p->irqenable);
|
|
u32 status = mbox_read_reg(p->irqstatus);
|
|
|
|
return (int)(enable & status & bit);
|
|
}
|
|
|
|
static void omap2_mbox_save_ctx(struct omap_mbox *mbox)
|
|
{
|
|
int i;
|
|
struct omap_mbox2_priv *p = mbox->priv;
|
|
int nr_regs;
|
|
if (cpu_is_omap44xx())
|
|
nr_regs = OMAP4_MBOX_NR_REGS;
|
|
else
|
|
nr_regs = MBOX_NR_REGS;
|
|
for (i = 0; i < nr_regs; i++) {
|
|
p->ctx[i] = mbox_read_reg(i * sizeof(u32));
|
|
|
|
dev_dbg(mbox->dev, "%s: [%02x] %08x\n", __func__,
|
|
i, p->ctx[i]);
|
|
}
|
|
}
|
|
|
|
static void omap2_mbox_restore_ctx(struct omap_mbox *mbox)
|
|
{
|
|
int i;
|
|
struct omap_mbox2_priv *p = mbox->priv;
|
|
int nr_regs;
|
|
if (cpu_is_omap44xx())
|
|
nr_regs = OMAP4_MBOX_NR_REGS;
|
|
else
|
|
nr_regs = MBOX_NR_REGS;
|
|
for (i = 0; i < nr_regs; i++) {
|
|
mbox_write_reg(p->ctx[i], i * sizeof(u32));
|
|
|
|
dev_dbg(mbox->dev, "%s: [%02x] %08x\n", __func__,
|
|
i, p->ctx[i]);
|
|
}
|
|
}
|
|
|
|
static struct omap_mbox_ops omap2_mbox_ops = {
|
|
.type = OMAP_MBOX_TYPE2,
|
|
.startup = omap2_mbox_startup,
|
|
.shutdown = omap2_mbox_shutdown,
|
|
.fifo_read = omap2_mbox_fifo_read,
|
|
.fifo_write = omap2_mbox_fifo_write,
|
|
.fifo_empty = omap2_mbox_fifo_empty,
|
|
.fifo_full = omap2_mbox_fifo_full,
|
|
.enable_irq = omap2_mbox_enable_irq,
|
|
.disable_irq = omap2_mbox_disable_irq,
|
|
.ack_irq = omap2_mbox_ack_irq,
|
|
.is_irq = omap2_mbox_is_irq,
|
|
.save_ctx = omap2_mbox_save_ctx,
|
|
.restore_ctx = omap2_mbox_restore_ctx,
|
|
};
|
|
|
|
/*
|
|
* MAILBOX 0: ARM -> DSP,
|
|
* MAILBOX 1: ARM <- DSP.
|
|
* MAILBOX 2: ARM -> IVA,
|
|
* MAILBOX 3: ARM <- IVA.
|
|
*/
|
|
|
|
/* FIXME: the following structs should be filled automatically by the user id */
|
|
|
|
#if defined(CONFIG_ARCH_OMAP3) || defined(CONFIG_ARCH_OMAP2)
|
|
/* DSP */
|
|
static struct omap_mbox2_priv omap2_mbox_dsp_priv = {
|
|
.tx_fifo = {
|
|
.msg = MAILBOX_MESSAGE(0),
|
|
.fifo_stat = MAILBOX_FIFOSTATUS(0),
|
|
},
|
|
.rx_fifo = {
|
|
.msg = MAILBOX_MESSAGE(1),
|
|
.msg_stat = MAILBOX_MSGSTATUS(1),
|
|
},
|
|
.irqenable = MAILBOX_IRQENABLE(0),
|
|
.irqstatus = MAILBOX_IRQSTATUS(0),
|
|
.notfull_bit = MAILBOX_IRQ_NOTFULL(0),
|
|
.newmsg_bit = MAILBOX_IRQ_NEWMSG(1),
|
|
.irqdisable = MAILBOX_IRQENABLE(0),
|
|
};
|
|
|
|
struct omap_mbox mbox_dsp_info = {
|
|
.name = "dsp",
|
|
.ops = &omap2_mbox_ops,
|
|
.priv = &omap2_mbox_dsp_priv,
|
|
};
|
|
#endif
|
|
|
|
#if defined(CONFIG_ARCH_OMAP3)
|
|
struct omap_mbox *omap3_mboxes[] = { &mbox_dsp_info, NULL };
|
|
#endif
|
|
|
|
#if defined(CONFIG_ARCH_OMAP2420)
|
|
/* IVA */
|
|
static struct omap_mbox2_priv omap2_mbox_iva_priv = {
|
|
.tx_fifo = {
|
|
.msg = MAILBOX_MESSAGE(2),
|
|
.fifo_stat = MAILBOX_FIFOSTATUS(2),
|
|
},
|
|
.rx_fifo = {
|
|
.msg = MAILBOX_MESSAGE(3),
|
|
.msg_stat = MAILBOX_MSGSTATUS(3),
|
|
},
|
|
.irqenable = MAILBOX_IRQENABLE(3),
|
|
.irqstatus = MAILBOX_IRQSTATUS(3),
|
|
.notfull_bit = MAILBOX_IRQ_NOTFULL(2),
|
|
.newmsg_bit = MAILBOX_IRQ_NEWMSG(3),
|
|
.irqdisable = MAILBOX_IRQENABLE(3),
|
|
};
|
|
|
|
static struct omap_mbox mbox_iva_info = {
|
|
.name = "iva",
|
|
.ops = &omap2_mbox_ops,
|
|
.priv = &omap2_mbox_iva_priv,
|
|
};
|
|
|
|
struct omap_mbox *omap2_mboxes[] = { &mbox_iva_info, &mbox_dsp_info, NULL };
|
|
#endif
|
|
|
|
#if defined(CONFIG_ARCH_OMAP4)
|
|
/* OMAP4 */
|
|
static struct omap_mbox2_priv omap2_mbox_1_priv = {
|
|
.tx_fifo = {
|
|
.msg = MAILBOX_MESSAGE(0),
|
|
.fifo_stat = MAILBOX_FIFOSTATUS(0),
|
|
},
|
|
.rx_fifo = {
|
|
.msg = MAILBOX_MESSAGE(1),
|
|
.msg_stat = MAILBOX_MSGSTATUS(1),
|
|
},
|
|
.irqenable = OMAP4_MAILBOX_IRQENABLE(0),
|
|
.irqstatus = OMAP4_MAILBOX_IRQSTATUS(0),
|
|
.notfull_bit = MAILBOX_IRQ_NOTFULL(0),
|
|
.newmsg_bit = MAILBOX_IRQ_NEWMSG(1),
|
|
.irqdisable = OMAP4_MAILBOX_IRQENABLE_CLR(0),
|
|
};
|
|
|
|
struct omap_mbox mbox_1_info = {
|
|
.name = "mailbox-1",
|
|
.ops = &omap2_mbox_ops,
|
|
.priv = &omap2_mbox_1_priv,
|
|
};
|
|
|
|
static struct omap_mbox2_priv omap2_mbox_2_priv = {
|
|
.tx_fifo = {
|
|
.msg = MAILBOX_MESSAGE(3),
|
|
.fifo_stat = MAILBOX_FIFOSTATUS(3),
|
|
},
|
|
.rx_fifo = {
|
|
.msg = MAILBOX_MESSAGE(2),
|
|
.msg_stat = MAILBOX_MSGSTATUS(2),
|
|
},
|
|
.irqenable = OMAP4_MAILBOX_IRQENABLE(0),
|
|
.irqstatus = OMAP4_MAILBOX_IRQSTATUS(0),
|
|
.notfull_bit = MAILBOX_IRQ_NOTFULL(3),
|
|
.newmsg_bit = MAILBOX_IRQ_NEWMSG(2),
|
|
.irqdisable = OMAP4_MAILBOX_IRQENABLE_CLR(0),
|
|
};
|
|
|
|
struct omap_mbox mbox_2_info = {
|
|
.name = "mailbox-2",
|
|
.ops = &omap2_mbox_ops,
|
|
.priv = &omap2_mbox_2_priv,
|
|
};
|
|
|
|
struct omap_mbox *omap4_mboxes[] = { &mbox_1_info, &mbox_2_info, NULL };
|
|
#endif
|
|
|
|
static int __devinit omap2_mbox_probe(struct platform_device *pdev)
|
|
{
|
|
struct resource *mem;
|
|
int ret;
|
|
struct omap_mbox **list;
|
|
|
|
if (false)
|
|
;
|
|
#if defined(CONFIG_ARCH_OMAP3)
|
|
else if (cpu_is_omap34xx()) {
|
|
list = omap3_mboxes;
|
|
|
|
list[0]->irq = platform_get_irq_byname(pdev, "dsp");
|
|
}
|
|
#endif
|
|
#if defined(CONFIG_ARCH_OMAP2)
|
|
else if (cpu_is_omap2430()) {
|
|
list = omap2_mboxes;
|
|
|
|
list[0]->irq = platform_get_irq_byname(pdev, "dsp");
|
|
} else if (cpu_is_omap2420()) {
|
|
list = omap2_mboxes;
|
|
|
|
list[0]->irq = platform_get_irq_byname(pdev, "dsp");
|
|
list[1]->irq = platform_get_irq_byname(pdev, "iva");
|
|
}
|
|
#endif
|
|
#if defined(CONFIG_ARCH_OMAP4)
|
|
else if (cpu_is_omap44xx()) {
|
|
list = omap4_mboxes;
|
|
|
|
list[0]->irq = list[1]->irq =
|
|
platform_get_irq_byname(pdev, "mbox");
|
|
}
|
|
#endif
|
|
else {
|
|
pr_err("%s: platform not supported\n", __func__);
|
|
return -ENODEV;
|
|
}
|
|
|
|
mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
mbox_base = ioremap(mem->start, resource_size(mem));
|
|
if (!mbox_base)
|
|
return -ENOMEM;
|
|
|
|
ret = omap_mbox_register(&pdev->dev, list);
|
|
if (ret) {
|
|
iounmap(mbox_base);
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int __devexit omap2_mbox_remove(struct platform_device *pdev)
|
|
{
|
|
omap_mbox_unregister();
|
|
iounmap(mbox_base);
|
|
return 0;
|
|
}
|
|
|
|
static struct platform_driver omap2_mbox_driver = {
|
|
.probe = omap2_mbox_probe,
|
|
.remove = __devexit_p(omap2_mbox_remove),
|
|
.driver = {
|
|
.name = "omap-mailbox",
|
|
},
|
|
};
|
|
|
|
static int __init omap2_mbox_init(void)
|
|
{
|
|
return platform_driver_register(&omap2_mbox_driver);
|
|
}
|
|
|
|
static void __exit omap2_mbox_exit(void)
|
|
{
|
|
platform_driver_unregister(&omap2_mbox_driver);
|
|
}
|
|
|
|
module_init(omap2_mbox_init);
|
|
module_exit(omap2_mbox_exit);
|
|
|
|
MODULE_LICENSE("GPL v2");
|
|
MODULE_DESCRIPTION("omap mailbox: omap2/3/4 architecture specific functions");
|
|
MODULE_AUTHOR("Hiroshi DOYU <Hiroshi.DOYU@nokia.com>");
|
|
MODULE_AUTHOR("Paul Mundt");
|
|
MODULE_ALIAS("platform:omap2-mailbox");
|