/* $NetBSD: external_io.c,v 1.2 2013/06/22 13:32:54 kiyohara Exp $ */ /* * Copyright (c) 1997 Mark Brinicombe. * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * This product includes software developed by Mark Brinicombe. * 4. The name of the company nor the name of the author may be used to * endorse or promote products derived from this software without specific * prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. * IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. */ /* * bus_space I/O functions for external bus */ #include __KERNEL_RCSID(0, "$NetBSD: external_io.c,v 1.2 2013/06/22 13:32:54 kiyohara Exp $"); #include #include #include /* Proto types for all the bus_space structure functions */ bs_protos(external); bs_protos(bs_notimpl); bs_protos(mainbus); /* Declare the external bus space tag */ struct bus_space external_bs_tag = { /* cookie */ (void *) 0, /* Shift to apply to registers */ /* mapping/unmapping */ mainbus_bs_map, mainbus_bs_unmap, external_bs_subregion, /* allocation/deallocation */ mainbus_bs_alloc, mainbus_bs_free, /* get kernel virtual address */ 0, /* there is no linear mapping */ /* mmap bus space for userland */ mainbus_bs_mmap, /* barrier */ mainbus_bs_barrier, /* read (single) */ external_bs_r_1, bs_notimpl_bs_r_2, external_bs_r_4, bs_notimpl_bs_r_8, /* read multiple */ external_bs_rm_1, external_bs_rm_2, external_bs_rm_4, bs_notimpl_bs_rm_8, /* read region */ external_bs_rr_1, external_bs_rr_2, bs_notimpl_bs_rr_4, bs_notimpl_bs_rr_8, /* write (single) */ external_bs_w_1, bs_notimpl_bs_w_2, external_bs_w_4, bs_notimpl_bs_w_8, /* write multiple */ external_bs_wm_1, external_bs_wm_2, external_bs_wm_4, bs_notimpl_bs_wm_8, /* write region */ external_bs_wr_1, external_bs_wr_2, bs_notimpl_bs_wr_4, bs_notimpl_bs_wr_8, /* set multiple */ bs_notimpl_bs_sm_1, bs_notimpl_bs_sm_2, bs_notimpl_bs_sm_4, bs_notimpl_bs_sm_8, /* set region */ external_bs_sr_1, external_bs_sr_2, bs_notimpl_bs_sr_4, bs_notimpl_bs_sr_8, /* copy */ bs_notimpl_bs_c_1, bs_notimpl_bs_c_2, bs_notimpl_bs_c_4, bs_notimpl_bs_c_8, }; /* bus space functions */ int external_bs_subregion(void *t, bus_space_handle_t bsh, bus_size_t offset, bus_size_t size, bus_space_handle_t *nbshp) { *nbshp = bsh + offset; return 0; } /* Rough-and-ready implementations from arm26 */ void external_bs_rr_1(void *cookie, bus_space_handle_t bsh, bus_size_t offset, uint8_t *datap, bus_size_t count) { int i; for (i = 0; i < count; i++) datap[i] = external_bs_r_1(cookie, bsh, offset + i); } void external_bs_rr_2(void *cookie, bus_space_handle_t bsh, bus_size_t offset, uint16_t *datap, bus_size_t count) { int i; for (i = 0; count - i > 1 && i < count; i += 2) *(uint32_t *)(&datap[i]) = external_bs_r_4(cookie, bsh, offset + (i << 1)); for (; i < count; i++) datap[i] = external_bs_r_1(cookie, bsh, offset + (i << 1)) | external_bs_r_1(cookie, bsh, offset + (i << 1) + 1); } void external_bs_wr_1(void *cookie, bus_space_handle_t bsh, bus_size_t offset, uint8_t const *datap, bus_size_t count) { int i; for (i = 0; i < count; i++) external_bs_w_1(cookie, bsh, offset + i, datap[i]); } void external_bs_wr_2(void *cookie, bus_space_handle_t bsh, bus_size_t offset, uint16_t const *datap, bus_size_t count) { int i; uint16_t v; for (i = 0; count - i > 1 && i < count; i += 2) external_bs_w_4(cookie, bsh, offset + (i << 1), *(const uint32_t *)(&datap[i])); for (; i < count; i++) { v = datap[i]; external_bs_w_1(cookie, bsh, offset + (i << 1), v & 0xff); external_bs_w_1(cookie, bsh, offset + (i << 1) + 1, v >> 8); } } void external_bs_sr_1(void *cookie, bus_space_handle_t bsh, bus_size_t offset, uint8_t value, bus_size_t count) { int i; for (i = 0; i < count; i++) external_bs_w_1(cookie, bsh, offset + i, value); } void external_bs_sr_2(void *cookie, bus_space_handle_t bsh, bus_size_t offset, uint16_t value, bus_size_t count) { int i; for (i = 0; count - i > 1 && i < count; i += 2) external_bs_w_4(cookie, bsh, offset + (i << 1), value | (value << 16)); for (; i < count; i++) { external_bs_w_1(cookie, bsh, offset + (i << 1), value & 0xff); external_bs_w_1(cookie, bsh, offset + (i << 1) + 1, value >> 8); } }