Home | History | Annotate | Line # | Download | only in broadcom
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