2 * Mailbox reservation modules for OMAP2/3
4 * Copyright (C) 2006-2009 Nokia Corporation
5 * Written by: Hiroshi DOYU <Hiroshi.DOYU@nokia.com>
8 * This file is subject to the terms and conditions of the GNU General Public
9 * License. See the file "COPYING" in the main directory of this archive
13 #include <linux/clk.h>
14 #include <linux/err.h>
15 #include <linux/platform_device.h>
17 #include <plat/mailbox.h>
18 #include <mach/irqs.h>
20 #define MAILBOX_REVISION 0x000
21 #define MAILBOX_SYSCONFIG 0x010
22 #define MAILBOX_SYSSTATUS 0x014
23 #define MAILBOX_MESSAGE(m) (0x040 + 4 * (m))
24 #define MAILBOX_FIFOSTATUS(m) (0x080 + 4 * (m))
25 #define MAILBOX_MSGSTATUS(m) (0x0c0 + 4 * (m))
26 #define MAILBOX_IRQSTATUS(u) (0x100 + 8 * (u))
27 #define MAILBOX_IRQENABLE(u) (0x104 + 8 * (u))
29 #define OMAP4_MAILBOX_IRQSTATUS(u) (0x104 + 10 * (u))
30 #define OMAP4_MAILBOX_IRQENABLE(u) (0x108 + 10 * (u))
31 #define OMAP4_MAILBOX_IRQENABLE_CLR(u) (0x10c + 10 * (u))
33 #define MAILBOX_IRQ_NEWMSG(m) (1 << (2 * (m)))
34 #define MAILBOX_IRQ_NOTFULL(m) (1 << (2 * (m) + 1))
36 /* SYSCONFIG: register bit definition */
37 #define AUTOIDLE (1 << 0)
38 #define SOFTRESET (1 << 1)
39 #define SMARTIDLE (2 << 3)
40 #define OMAP4_SOFTRESET (1 << 0)
41 #define OMAP4_NOIDLE (1 << 2)
42 #define OMAP4_SMARTIDLE (2 << 2)
44 /* SYSSTATUS: register bit definition */
45 #define RESETDONE (1 << 0)
47 #define MBOX_REG_SIZE 0x120
49 #define OMAP4_MBOX_REG_SIZE 0x130
51 #define MBOX_NR_REGS (MBOX_REG_SIZE / sizeof(u32))
52 #define OMAP4_MBOX_NR_REGS (OMAP4_MBOX_REG_SIZE / sizeof(u32))
54 static void __iomem
*mbox_base
;
56 struct omap_mbox2_fifo
{
58 unsigned long fifo_stat
;
59 unsigned long msg_stat
;
62 struct omap_mbox2_priv
{
63 struct omap_mbox2_fifo tx_fifo
;
64 struct omap_mbox2_fifo rx_fifo
;
65 unsigned long irqenable
;
66 unsigned long irqstatus
;
69 u32 ctx
[OMAP4_MBOX_NR_REGS
];
70 unsigned long irqdisable
;
73 static struct clk
*mbox_ick_handle
;
75 static void omap2_mbox_enable_irq(struct omap_mbox
*mbox
,
76 omap_mbox_type_t irq
);
78 static inline unsigned int mbox_read_reg(size_t ofs
)
80 return __raw_readl(mbox_base
+ ofs
);
83 static inline void mbox_write_reg(u32 val
, size_t ofs
)
85 __raw_writel(val
, mbox_base
+ ofs
);
88 /* Mailbox H/W preparations */
89 static int omap2_mbox_startup(struct omap_mbox
*mbox
)
92 unsigned long timeout
;
94 mbox_ick_handle
= clk_get(NULL
, "mailboxes_ick");
95 if (IS_ERR(mbox_ick_handle
)) {
96 printk(KERN_ERR
"Could not get mailboxes_ick: %ld\n",
97 PTR_ERR(mbox_ick_handle
));
98 return PTR_ERR(mbox_ick_handle
);
100 clk_enable(mbox_ick_handle
);
102 if (cpu_is_omap44xx()) {
103 mbox_write_reg(OMAP4_SOFTRESET
, MAILBOX_SYSCONFIG
);
104 timeout
= jiffies
+ msecs_to_jiffies(20);
106 l
= mbox_read_reg(MAILBOX_SYSCONFIG
);
107 if (!(l
& OMAP4_SOFTRESET
))
109 } while (!time_after(jiffies
, timeout
));
111 if (l
& OMAP4_SOFTRESET
) {
112 pr_err("Can't take mailbox out of reset\n");
116 mbox_write_reg(SOFTRESET
, MAILBOX_SYSCONFIG
);
117 timeout
= jiffies
+ msecs_to_jiffies(20);
119 l
= mbox_read_reg(MAILBOX_SYSSTATUS
);
122 } while (!time_after(jiffies
, timeout
));
124 if (!(l
& RESETDONE
)) {
125 pr_err("Can't take mailbox out of reset\n");
130 l
= mbox_read_reg(MAILBOX_REVISION
);
131 pr_debug("omap mailbox rev %d.%d\n", (l
& 0xf0) >> 4, (l
& 0x0f));
133 if (cpu_is_omap44xx())
136 l
= SMARTIDLE
| AUTOIDLE
;
137 mbox_write_reg(l
, MAILBOX_SYSCONFIG
);
139 omap2_mbox_enable_irq(mbox
, IRQ_RX
);
144 static void omap2_mbox_shutdown(struct omap_mbox
*mbox
)
146 clk_disable(mbox_ick_handle
);
147 clk_put(mbox_ick_handle
);
148 mbox_ick_handle
= NULL
;
151 /* Mailbox FIFO handle functions */
152 static mbox_msg_t
omap2_mbox_fifo_read(struct omap_mbox
*mbox
)
154 struct omap_mbox2_fifo
*fifo
=
155 &((struct omap_mbox2_priv
*)mbox
->priv
)->rx_fifo
;
156 return (mbox_msg_t
) mbox_read_reg(fifo
->msg
);
159 static void omap2_mbox_fifo_write(struct omap_mbox
*mbox
, mbox_msg_t msg
)
161 struct omap_mbox2_fifo
*fifo
=
162 &((struct omap_mbox2_priv
*)mbox
->priv
)->tx_fifo
;
163 mbox_write_reg(msg
, fifo
->msg
);
166 static int omap2_mbox_fifo_empty(struct omap_mbox
*mbox
)
168 struct omap_mbox2_fifo
*fifo
=
169 &((struct omap_mbox2_priv
*)mbox
->priv
)->rx_fifo
;
170 return (mbox_read_reg(fifo
->msg_stat
) == 0);
173 static int omap2_mbox_fifo_full(struct omap_mbox
*mbox
)
175 struct omap_mbox2_fifo
*fifo
=
176 &((struct omap_mbox2_priv
*)mbox
->priv
)->tx_fifo
;
177 return mbox_read_reg(fifo
->fifo_stat
);
180 /* Mailbox IRQ handle functions */
181 static void omap2_mbox_enable_irq(struct omap_mbox
*mbox
,
182 omap_mbox_type_t irq
)
184 struct omap_mbox2_priv
*p
= mbox
->priv
;
185 u32 l
, bit
= (irq
== IRQ_TX
) ? p
->notfull_bit
: p
->newmsg_bit
;
187 l
= mbox_read_reg(p
->irqenable
);
189 mbox_write_reg(l
, p
->irqenable
);
192 static void omap2_mbox_disable_irq(struct omap_mbox
*mbox
,
193 omap_mbox_type_t irq
)
195 struct omap_mbox2_priv
*p
= mbox
->priv
;
196 u32 l
, bit
= (irq
== IRQ_TX
) ? p
->notfull_bit
: p
->newmsg_bit
;
197 l
= mbox_read_reg(p
->irqdisable
);
199 mbox_write_reg(l
, p
->irqdisable
);
202 static void omap2_mbox_ack_irq(struct omap_mbox
*mbox
,
203 omap_mbox_type_t irq
)
205 struct omap_mbox2_priv
*p
= mbox
->priv
;
206 u32 bit
= (irq
== IRQ_TX
) ? p
->notfull_bit
: p
->newmsg_bit
;
208 mbox_write_reg(bit
, p
->irqstatus
);
210 /* Flush posted write for irq status to avoid spurious interrupts */
211 mbox_read_reg(p
->irqstatus
);
214 static int omap2_mbox_is_irq(struct omap_mbox
*mbox
,
215 omap_mbox_type_t irq
)
217 struct omap_mbox2_priv
*p
= mbox
->priv
;
218 u32 bit
= (irq
== IRQ_TX
) ? p
->notfull_bit
: p
->newmsg_bit
;
219 u32 enable
= mbox_read_reg(p
->irqenable
);
220 u32 status
= mbox_read_reg(p
->irqstatus
);
222 return (int)(enable
& status
& bit
);
225 static void omap2_mbox_save_ctx(struct omap_mbox
*mbox
)
228 struct omap_mbox2_priv
*p
= mbox
->priv
;
230 if (cpu_is_omap44xx())
231 nr_regs
= OMAP4_MBOX_NR_REGS
;
233 nr_regs
= MBOX_NR_REGS
;
234 for (i
= 0; i
< nr_regs
; i
++) {
235 p
->ctx
[i
] = mbox_read_reg(i
* sizeof(u32
));
237 dev_dbg(mbox
->dev
, "%s: [%02x] %08x\n", __func__
,
242 static void omap2_mbox_restore_ctx(struct omap_mbox
*mbox
)
245 struct omap_mbox2_priv
*p
= mbox
->priv
;
247 if (cpu_is_omap44xx())
248 nr_regs
= OMAP4_MBOX_NR_REGS
;
250 nr_regs
= MBOX_NR_REGS
;
251 for (i
= 0; i
< nr_regs
; i
++) {
252 mbox_write_reg(p
->ctx
[i
], i
* sizeof(u32
));
254 dev_dbg(mbox
->dev
, "%s: [%02x] %08x\n", __func__
,
259 static struct omap_mbox_ops omap2_mbox_ops
= {
260 .type
= OMAP_MBOX_TYPE2
,
261 .startup
= omap2_mbox_startup
,
262 .shutdown
= omap2_mbox_shutdown
,
263 .fifo_read
= omap2_mbox_fifo_read
,
264 .fifo_write
= omap2_mbox_fifo_write
,
265 .fifo_empty
= omap2_mbox_fifo_empty
,
266 .fifo_full
= omap2_mbox_fifo_full
,
267 .enable_irq
= omap2_mbox_enable_irq
,
268 .disable_irq
= omap2_mbox_disable_irq
,
269 .ack_irq
= omap2_mbox_ack_irq
,
270 .is_irq
= omap2_mbox_is_irq
,
271 .save_ctx
= omap2_mbox_save_ctx
,
272 .restore_ctx
= omap2_mbox_restore_ctx
,
276 * MAILBOX 0: ARM -> DSP,
277 * MAILBOX 1: ARM <- DSP.
278 * MAILBOX 2: ARM -> IVA,
279 * MAILBOX 3: ARM <- IVA.
282 /* FIXME: the following structs should be filled automatically by the user id */
284 #if defined(CONFIG_ARCH_OMAP3) || defined(CONFIG_ARCH_OMAP2)
286 static struct omap_mbox2_priv omap2_mbox_dsp_priv
= {
288 .msg
= MAILBOX_MESSAGE(0),
289 .fifo_stat
= MAILBOX_FIFOSTATUS(0),
292 .msg
= MAILBOX_MESSAGE(1),
293 .msg_stat
= MAILBOX_MSGSTATUS(1),
295 .irqenable
= MAILBOX_IRQENABLE(0),
296 .irqstatus
= MAILBOX_IRQSTATUS(0),
297 .notfull_bit
= MAILBOX_IRQ_NOTFULL(0),
298 .newmsg_bit
= MAILBOX_IRQ_NEWMSG(1),
299 .irqdisable
= MAILBOX_IRQENABLE(0),
302 struct omap_mbox mbox_dsp_info
= {
304 .ops
= &omap2_mbox_ops
,
305 .priv
= &omap2_mbox_dsp_priv
,
309 #if defined(CONFIG_ARCH_OMAP3)
310 struct omap_mbox
*omap3_mboxes
[] = { &mbox_dsp_info
, NULL
};
313 #if defined(CONFIG_ARCH_OMAP2420)
315 static struct omap_mbox2_priv omap2_mbox_iva_priv
= {
317 .msg
= MAILBOX_MESSAGE(2),
318 .fifo_stat
= MAILBOX_FIFOSTATUS(2),
321 .msg
= MAILBOX_MESSAGE(3),
322 .msg_stat
= MAILBOX_MSGSTATUS(3),
324 .irqenable
= MAILBOX_IRQENABLE(3),
325 .irqstatus
= MAILBOX_IRQSTATUS(3),
326 .notfull_bit
= MAILBOX_IRQ_NOTFULL(2),
327 .newmsg_bit
= MAILBOX_IRQ_NEWMSG(3),
328 .irqdisable
= MAILBOX_IRQENABLE(3),
331 static struct omap_mbox mbox_iva_info
= {
333 .ops
= &omap2_mbox_ops
,
334 .priv
= &omap2_mbox_iva_priv
,
337 struct omap_mbox
*omap2_mboxes
[] = { &mbox_dsp_info
, &mbox_iva_info
, NULL
};
340 #if defined(CONFIG_ARCH_OMAP4)
342 static struct omap_mbox2_priv omap2_mbox_1_priv
= {
344 .msg
= MAILBOX_MESSAGE(0),
345 .fifo_stat
= MAILBOX_FIFOSTATUS(0),
348 .msg
= MAILBOX_MESSAGE(1),
349 .msg_stat
= MAILBOX_MSGSTATUS(1),
351 .irqenable
= OMAP4_MAILBOX_IRQENABLE(0),
352 .irqstatus
= OMAP4_MAILBOX_IRQSTATUS(0),
353 .notfull_bit
= MAILBOX_IRQ_NOTFULL(0),
354 .newmsg_bit
= MAILBOX_IRQ_NEWMSG(1),
355 .irqdisable
= OMAP4_MAILBOX_IRQENABLE_CLR(0),
358 struct omap_mbox mbox_1_info
= {
360 .ops
= &omap2_mbox_ops
,
361 .priv
= &omap2_mbox_1_priv
,
364 static struct omap_mbox2_priv omap2_mbox_2_priv
= {
366 .msg
= MAILBOX_MESSAGE(3),
367 .fifo_stat
= MAILBOX_FIFOSTATUS(3),
370 .msg
= MAILBOX_MESSAGE(2),
371 .msg_stat
= MAILBOX_MSGSTATUS(2),
373 .irqenable
= OMAP4_MAILBOX_IRQENABLE(0),
374 .irqstatus
= OMAP4_MAILBOX_IRQSTATUS(0),
375 .notfull_bit
= MAILBOX_IRQ_NOTFULL(3),
376 .newmsg_bit
= MAILBOX_IRQ_NEWMSG(2),
377 .irqdisable
= OMAP4_MAILBOX_IRQENABLE_CLR(0),
380 struct omap_mbox mbox_2_info
= {
382 .ops
= &omap2_mbox_ops
,
383 .priv
= &omap2_mbox_2_priv
,
386 struct omap_mbox
*omap4_mboxes
[] = { &mbox_1_info
, &mbox_2_info
, NULL
};
389 static int __devinit
omap2_mbox_probe(struct platform_device
*pdev
)
391 struct resource
*mem
;
393 struct omap_mbox
**list
;
397 #if defined(CONFIG_ARCH_OMAP3)
398 else if (cpu_is_omap34xx()) {
401 list
[0]->irq
= platform_get_irq_byname(pdev
, "dsp");
404 #if defined(CONFIG_ARCH_OMAP2)
405 else if (cpu_is_omap2430()) {
408 list
[0]->irq
= platform_get_irq_byname(pdev
, "dsp");
409 } else if (cpu_is_omap2420()) {
412 list
[0]->irq
= platform_get_irq_byname(pdev
, "dsp");
413 list
[1]->irq
= platform_get_irq_byname(pdev
, "iva");
416 #if defined(CONFIG_ARCH_OMAP4)
417 else if (cpu_is_omap44xx()) {
420 list
[0]->irq
= list
[1]->irq
=
421 platform_get_irq_byname(pdev
, "mbox");
425 pr_err("%s: platform not supported\n", __func__
);
429 mem
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
430 mbox_base
= ioremap(mem
->start
, resource_size(mem
));
434 ret
= omap_mbox_register(&pdev
->dev
, list
);
443 static int __devexit
omap2_mbox_remove(struct platform_device
*pdev
)
445 omap_mbox_unregister();
450 static struct platform_driver omap2_mbox_driver
= {
451 .probe
= omap2_mbox_probe
,
452 .remove
= __devexit_p(omap2_mbox_remove
),
454 .name
= "omap-mailbox",
458 static int __init
omap2_mbox_init(void)
460 return platform_driver_register(&omap2_mbox_driver
);
463 static void __exit
omap2_mbox_exit(void)
465 platform_driver_unregister(&omap2_mbox_driver
);
468 module_init(omap2_mbox_init
);
469 module_exit(omap2_mbox_exit
);
471 MODULE_LICENSE("GPL v2");
472 MODULE_DESCRIPTION("omap mailbox: omap2/3/4 architecture specific functions");
473 MODULE_AUTHOR("Hiroshi DOYU <Hiroshi.DOYU@nokia.com>");
474 MODULE_AUTHOR("Paul Mundt");
475 MODULE_ALIAS("platform:omap2-mailbox");