bcm2835_mbox_subr.c revision 1.3.2.2 1 1.3.2.2 yamt /* $NetBSD: bcm2835_mbox_subr.c,v 1.3.2.2 2012/10/30 17:18:59 yamt Exp $ */
2 1.3.2.2 yamt
3 1.3.2.2 yamt /*-
4 1.3.2.2 yamt * Copyright (c) 2012 The NetBSD Foundation, Inc.
5 1.3.2.2 yamt * All rights reserved.
6 1.3.2.2 yamt *
7 1.3.2.2 yamt * This code is derived from software contributed to The NetBSD Foundation
8 1.3.2.2 yamt * by Nick Hudson
9 1.3.2.2 yamt *
10 1.3.2.2 yamt * Redistribution and use in source and binary forms, with or without
11 1.3.2.2 yamt * modification, are permitted provided that the following conditions
12 1.3.2.2 yamt * are met:
13 1.3.2.2 yamt * 1. Redistributions of source code must retain the above copyright
14 1.3.2.2 yamt * notice, this list of conditions and the following disclaimer.
15 1.3.2.2 yamt * 2. Redistributions in binary form must reproduce the above copyright
16 1.3.2.2 yamt * notice, this list of conditions and the following disclaimer in the
17 1.3.2.2 yamt * documentation and/or other materials provided with the distribution.
18 1.3.2.2 yamt *
19 1.3.2.2 yamt * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.3.2.2 yamt * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.3.2.2 yamt * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.3.2.2 yamt * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.3.2.2 yamt * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.3.2.2 yamt * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.3.2.2 yamt * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.3.2.2 yamt * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.3.2.2 yamt * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.3.2.2 yamt * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.3.2.2 yamt * POSSIBILITY OF SUCH DAMAGE.
30 1.3.2.2 yamt */
31 1.3.2.2 yamt
32 1.3.2.2 yamt #include <sys/cdefs.h>
33 1.3.2.2 yamt __KERNEL_RCSID(0, "$NetBSD: bcm2835_mbox_subr.c,v 1.3.2.2 2012/10/30 17:18:59 yamt Exp $");
34 1.3.2.2 yamt
35 1.3.2.2 yamt #include <sys/param.h>
36 1.3.2.2 yamt #include <sys/systm.h>
37 1.3.2.2 yamt #include <sys/device.h>
38 1.3.2.2 yamt #include <sys/kernel.h>
39 1.3.2.2 yamt #include <sys/timetc.h>
40 1.3.2.2 yamt #include <sys/bus.h>
41 1.3.2.2 yamt
42 1.3.2.2 yamt #include <arm/broadcom/bcm_amba.h>
43 1.3.2.2 yamt #include <arm/broadcom/bcm2835_mbox.h>
44 1.3.2.2 yamt #include <arm/broadcom/bcm2835_mboxreg.h>
45 1.3.2.2 yamt #include <arm/broadcom/bcm2835reg.h>
46 1.3.2.2 yamt
47 1.3.2.2 yamt
48 1.3.2.2 yamt #define BCM2835_MBOX_CHAN(chan) ((chan) & 0xf)
49 1.3.2.2 yamt #define BCM2835_MBOX_DATA(data) ((data) & ~0xf)
50 1.3.2.2 yamt
51 1.3.2.2 yamt #define BCM2835_MBOX_MSG(chan, data) (((chan) & 0xf) | ((data) & ~0xf))
52 1.3.2.2 yamt
53 1.3.2.2 yamt void
54 1.3.2.2 yamt bcm2835_mbox_read(bus_space_tag_t iot, bus_space_handle_t ioh, uint8_t chan,
55 1.3.2.2 yamt uint32_t *data)
56 1.3.2.2 yamt {
57 1.3.2.2 yamt uint32_t mbox;
58 1.3.2.2 yamt
59 1.3.2.2 yamt KASSERT((chan & 0xf) == chan);
60 1.3.2.2 yamt
61 1.3.2.2 yamt for (;;) {
62 1.3.2.2 yamt uint8_t rchan;
63 1.3.2.2 yamt uint32_t rdata;
64 1.3.2.2 yamt
65 1.3.2.2 yamt bus_space_barrier(iot, ioh, 0, BCM2835_MBOX_SIZE,
66 1.3.2.2 yamt BUS_SPACE_BARRIER_READ);
67 1.3.2.2 yamt
68 1.3.2.2 yamt if ((bus_space_read_4(iot, ioh,
69 1.3.2.2 yamt BCM2835_MBOX0_STATUS) & BCM2835_MBOX_STATUS_EMPTY) != 0)
70 1.3.2.2 yamt continue;
71 1.3.2.2 yamt
72 1.3.2.2 yamt mbox = bus_space_read_4(iot, ioh, BCM2835_MBOX0_READ);
73 1.3.2.2 yamt
74 1.3.2.2 yamt rchan = BCM2835_MBOX_CHAN(mbox);
75 1.3.2.2 yamt rdata = BCM2835_MBOX_DATA(mbox);
76 1.3.2.2 yamt
77 1.3.2.2 yamt if (rchan == chan) {
78 1.3.2.2 yamt *data = rdata;
79 1.3.2.2 yamt return;
80 1.3.2.2 yamt }
81 1.3.2.2 yamt }
82 1.3.2.2 yamt }
83 1.3.2.2 yamt
84 1.3.2.2 yamt void
85 1.3.2.2 yamt bcm2835_mbox_write(bus_space_tag_t iot, bus_space_handle_t ioh, uint8_t chan,
86 1.3.2.2 yamt uint32_t data)
87 1.3.2.2 yamt {
88 1.3.2.2 yamt uint32_t rdata;
89 1.3.2.2 yamt
90 1.3.2.2 yamt KASSERT((chan & 0xf) == chan);
91 1.3.2.2 yamt KASSERT((data & 0xf) == 0);
92 1.3.2.2 yamt for (;;) {
93 1.3.2.2 yamt
94 1.3.2.2 yamt bus_space_barrier(iot, ioh, 0, BCM2835_MBOX_SIZE,
95 1.3.2.2 yamt BUS_SPACE_BARRIER_READ);
96 1.3.2.2 yamt
97 1.3.2.2 yamt if ((rdata = bus_space_read_4(iot, ioh,
98 1.3.2.2 yamt BCM2835_MBOX0_STATUS) & BCM2835_MBOX_STATUS_FULL) == 0)
99 1.3.2.2 yamt break;
100 1.3.2.2 yamt }
101 1.3.2.2 yamt
102 1.3.2.2 yamt bus_space_write_4(iot, ioh, BCM2835_MBOX1_WRITE,
103 1.3.2.2 yamt BCM2835_MBOX_MSG(chan, data));
104 1.3.2.2 yamt
105 1.3.2.2 yamt bus_space_barrier(iot, ioh, 0, BCM2835_MBOX_SIZE,
106 1.3.2.2 yamt BUS_SPACE_BARRIER_WRITE);
107 1.3.2.2 yamt }
108