Home | History | Annotate | Line # | Download | only in marvell
mvsoc_space.c revision 1.5 
      1 /*	$NetBSD: mvsoc_space.c,v 1.5 2012/07/28 23:13:16 matt Exp $	*/
      2 /*
      3  * Copyright (c) 2007 KIYOHARA Takashi
      4  * All rights reserved.
      5  *
      6  * Redistribution and use in source and binary forms, with or without
      7  * modification, are permitted provided that the following conditions
      8  * are met:
      9  * 1. Redistributions of source code must retain the above copyright
     10  *    notice, this list of conditions and the following disclaimer.
     11  * 2. Redistributions in binary form must reproduce the above copyright
     12  *    notice, this list of conditions and the following disclaimer in the
     13  *    documentation and/or other materials provided with the distribution.
     14  *
     15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     17  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     18  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
     19  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     20  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     21  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     22  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     23  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
     24  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     25  * POSSIBILITY OF SUCH DAMAGE.
     26  */
     27 
     28 #include <sys/cdefs.h>
     29 __KERNEL_RCSID(0, "$NetBSD: mvsoc_space.c,v 1.5 2012/07/28 23:13:16 matt Exp $");
     30 
     31 #include "opt_mvsoc.h"
     32 #include "mvpex.h"
     33 #include "gtpci.h"
     34 
     35 #include <sys/param.h>
     36 #include <sys/systm.h>
     37 
     38 #include <uvm/uvm_extern.h>
     39 
     40 #include <sys/bus.h>
     41 
     42 #include <arm/marvell/mvsocreg.h>
     43 #include <arm/marvell/mvsocvar.h>
     44 
     45 
     46 /* Proto types for all the bus_space structure functions */
     47 bs_protos(mvsoc);
     48 bs_protos(generic);
     49 bs_protos(generic_armv4);
     50 bs_protos(bs_notimpl);
     51 
     52 #define MVSOC_BUS_SPACE_NORMAL_FUNCS		\
     53 	/* read (single) */			\
     54 	generic_bs_r_1,				\
     55 	generic_armv4_bs_r_2,			\
     56 	generic_bs_r_4,				\
     57 	bs_notimpl_bs_r_8,			\
     58 						\
     59 	/* read multiple */			\
     60 	generic_bs_rm_1,			\
     61 	generic_armv4_bs_rm_2,			\
     62 	generic_bs_rm_4,			\
     63 	bs_notimpl_bs_rm_8,			\
     64 						\
     65 	/* read region */			\
     66 	generic_bs_rr_1,			\
     67 	generic_armv4_bs_rr_2,			\
     68 	generic_bs_rr_4,			\
     69 	bs_notimpl_bs_rr_8,			\
     70 						\
     71 	/* write (single) */			\
     72 	generic_bs_w_1,				\
     73 	generic_armv4_bs_w_2,			\
     74 	generic_bs_w_4,				\
     75 	bs_notimpl_bs_w_8,			\
     76 						\
     77 	/* write multiple */			\
     78 	generic_bs_wm_1,			\
     79 	generic_armv4_bs_wm_2,			\
     80 	generic_bs_wm_4,			\
     81 	bs_notimpl_bs_wm_8,			\
     82 						\
     83 	/* write region */			\
     84 	generic_bs_wr_1,			\
     85 	generic_armv4_bs_wr_2,			\
     86 	generic_bs_wr_4,			\
     87 	bs_notimpl_bs_wr_8
     88 
     89 #define MVSOC_BUS_SPACE_DEFAULT_FUNCS		\
     90 	/* mapping/unmapping */			\
     91 	mvsoc_bs_map,				\
     92 	mvsoc_bs_unmap,				\
     93 	mvsoc_bs_subregion,			\
     94 						\
     95 	/* allocation/deallocation */		\
     96 	mvsoc_bs_alloc,				\
     97 	mvsoc_bs_free,				\
     98 						\
     99 	/* get kernel virtual address */	\
    100 	mvsoc_bs_vaddr,				\
    101 						\
    102 	/* mmap bus space for userland */	\
    103 	bs_notimpl_bs_mmap,			\
    104 						\
    105 	/* barrier */				\
    106 	mvsoc_bs_barrier,			\
    107 						\
    108 	MVSOC_BUS_SPACE_NORMAL_FUNCS,		\
    109 						\
    110 	/* set multiple */			\
    111 	bs_notimpl_bs_sm_1,			\
    112 	bs_notimpl_bs_sm_2,			\
    113 	bs_notimpl_bs_sm_4,			\
    114 	bs_notimpl_bs_sm_8,			\
    115 						\
    116 	/* set region */			\
    117 	bs_notimpl_bs_sr_1,			\
    118 	generic_armv4_bs_sr_2,			\
    119 	generic_bs_sr_4,			\
    120 	bs_notimpl_bs_sr_8,			\
    121 						\
    122 	/* copy */				\
    123 	bs_notimpl_bs_c_1,			\
    124 	generic_armv4_bs_c_2,			\
    125 	bs_notimpl_bs_c_4,			\
    126 	bs_notimpl_bs_c_8
    127 
    128 
    129 struct bus_space mvsoc_bs_tag = {
    130 	/* cookie */
    131 	(void *)0,
    132 
    133 	MVSOC_BUS_SPACE_DEFAULT_FUNCS,
    134 #ifdef __BUS_SPACE_HAS_STREAM_METHODS
    135 	MVSOC_BUS_SPACE_NORMAL_FUNCS,
    136 #endif
    137 };
    138 
    139 #if NMVPEX > 0
    140 #if defined(ORION)
    141 struct bus_space orion_pex0_mem_bs_tag = {
    142 	/* cookie */
    143 	(void *)ORION_TAG_PEX0_MEM,
    144 
    145 	MVSOC_BUS_SPACE_DEFAULT_FUNCS,
    146 #ifdef __BUS_SPACE_HAS_STREAM_METHODS
    147 	MVSOC_BUS_SPACE_NORMAL_FUNCS,
    148 #endif
    149 };
    150 struct bus_space orion_pex0_io_bs_tag = {
    151 	/* cookie */
    152 	(void *)ORION_TAG_PEX0_IO,
    153 
    154 	MVSOC_BUS_SPACE_DEFAULT_FUNCS,
    155 #ifdef __BUS_SPACE_HAS_STREAM_METHODS
    156 	MVSOC_BUS_SPACE_NORMAL_FUNCS,
    157 #endif
    158 };
    159 struct bus_space orion_pex1_mem_bs_tag = {
    160 	/* cookie */
    161 	(void *)ORION_TAG_PEX1_MEM,
    162 
    163 	MVSOC_BUS_SPACE_DEFAULT_FUNCS,
    164 #ifdef __BUS_SPACE_HAS_STREAM_METHODS
    165 	MVSOC_BUS_SPACE_NORMAL_FUNCS,
    166 #endif
    167 };
    168 struct bus_space orion_pex1_io_bs_tag = {
    169 	/* cookie */
    170 	(void *)ORION_TAG_PEX1_IO,
    171 
    172 	MVSOC_BUS_SPACE_DEFAULT_FUNCS,
    173 #ifdef __BUS_SPACE_HAS_STREAM_METHODS
    174 	MVSOC_BUS_SPACE_NORMAL_FUNCS,
    175 #endif
    176 };
    177 #endif
    178 
    179 #if defined(KIRKWOOD)
    180 struct bus_space kirkwood_pex_mem_bs_tag = {
    181 	/* cookie */
    182 	(void *)KIRKWOOD_TAG_PEX_MEM,
    183 
    184 	MVSOC_BUS_SPACE_DEFAULT_FUNCS,
    185 #ifdef __BUS_SPACE_HAS_STREAM_METHODS
    186 	MVSOC_BUS_SPACE_NORMAL_FUNCS,
    187 #endif
    188 };
    189 struct bus_space kirkwood_pex_io_bs_tag = {
    190 	/* cookie */
    191 	(void *)KIRKWOOD_TAG_PEX_IO,
    192 
    193 	MVSOC_BUS_SPACE_DEFAULT_FUNCS,
    194 #ifdef __BUS_SPACE_HAS_STREAM_METHODS
    195 	MVSOC_BUS_SPACE_NORMAL_FUNCS,
    196 #endif
    197 };
    198 struct bus_space kirkwood_pex1_mem_bs_tag = {
    199 	/* cookie */
    200 	(void *)KIRKWOOD_TAG_PEX1_MEM,
    201 
    202 	MVSOC_BUS_SPACE_DEFAULT_FUNCS,
    203 #ifdef __BUS_SPACE_HAS_STREAM_METHODS
    204 	MVSOC_BUS_SPACE_NORMAL_FUNCS,
    205 #endif
    206 };
    207 struct bus_space kirkwood_pex1_io_bs_tag = {
    208 	/* cookie */
    209 	(void *)KIRKWOOD_TAG_PEX1_IO,
    210 
    211 	MVSOC_BUS_SPACE_DEFAULT_FUNCS,
    212 #ifdef __BUS_SPACE_HAS_STREAM_METHODS
    213 	MVSOC_BUS_SPACE_NORMAL_FUNCS,
    214 #endif
    215 };
    216 #endif
    217 #endif
    218 
    219 #if NGTPCI > 0
    220 #if defined(ORION)
    221 struct bus_space orion_pci_mem_bs_tag = {
    222 	/* cookie */
    223 	(void *)ORION_TAG_PCI_MEM,
    224 
    225 	MVSOC_BUS_SPACE_DEFAULT_FUNCS,
    226 #ifdef __BUS_SPACE_HAS_STREAM_METHODS
    227 	MVSOC_BUS_SPACE_NORMAL_FUNCS,
    228 #endif
    229 };
    230 struct bus_space orion_pci_io_bs_tag = {
    231 	/* cookie */
    232 	(void *)ORION_TAG_PCI_IO,
    233 
    234 	MVSOC_BUS_SPACE_DEFAULT_FUNCS,
    235 #ifdef __BUS_SPACE_HAS_STREAM_METHODS
    236 	MVSOC_BUS_SPACE_NORMAL_FUNCS,
    237 #endif
    238 };
    239 #endif
    240 #endif
    241 
    242 
    243 int
    244 mvsoc_bs_map(void *space, bus_addr_t address, bus_size_t size, int flags,
    245 	     bus_space_handle_t *handlep)
    246 {
    247 	const struct pmap_devmap *pd;
    248 	paddr_t startpa, endpa, offset, pa;
    249 	pt_entry_t *pte;
    250 	vaddr_t va;
    251 	int tag = (int)space;
    252 
    253 	if (tag != 0) {
    254 		bus_addr_t remap;
    255 		uint32_t base;
    256 		int window;
    257 
    258 		window = mvsoc_target(tag, NULL, NULL, &base, NULL);
    259 		if (window == -1)
    260 			return ENOMEM;
    261 		if (window < nremap) {
    262 			remap = read_mlmbreg(MVSOC_MLMB_WRLR(window)) &
    263 			    MVSOC_MLMB_WRLR_REMAP_MASK;
    264 			remap |=
    265 			    (read_mlmbreg(MVSOC_MLMB_WRHR(window)) << 16) << 16;
    266 			address = address - remap + base;
    267 		}
    268 	}
    269 
    270 	if ((pd = pmap_devmap_find_pa(address, size)) != NULL) {
    271 		/* Device was statically mapped. */
    272 		*handlep = pd->pd_va + (address - pd->pd_pa);
    273 		return 0;
    274 	}
    275 
    276 	startpa = trunc_page(address);
    277 	endpa = round_page(address + size);
    278 	offset = address & PAGE_MASK;
    279 
    280 	/* XXX use extent manager to check duplicate mapping */
    281 
    282 	va = uvm_km_alloc(kernel_map, endpa - startpa, 0,
    283 	    UVM_KMF_VAONLY | UVM_KMF_NOWAIT);
    284 	if (va == 0x00000000)
    285 		return ENOMEM;
    286 
    287 	*handlep = va + offset;
    288 
    289 	/* Now map the pages */
    290 	for (pa = startpa; pa < endpa; pa += PAGE_SIZE, va += PAGE_SIZE) {
    291 		pmap_kenter_pa(va, pa, VM_PROT_READ | VM_PROT_WRITE, 0);
    292 		if ((flags & BUS_SPACE_MAP_CACHEABLE) == 0) {
    293 			pte = vtopte(va);
    294 			*pte &= ~L2_S_CACHE_MASK;
    295 			PTE_SYNC(pte);
    296 			/*
    297 			 * XXX: pmap_kenter_pa() also does PTE_SYNC(). a bit of
    298 			 *      waste.
    299 			 */
    300 		}
    301 	}
    302 	pmap_update(pmap_kernel());
    303 
    304 	return 0;
    305 }
    306 
    307 void
    308 mvsoc_bs_unmap(void *space, bus_space_handle_t handle, bus_size_t size)
    309 {
    310 	vaddr_t va, sz;
    311 
    312 	if (pmap_devmap_find_va(handle, size) != NULL)
    313 		/* Device was statically mapped; nothing to do. */
    314 		return;
    315 
    316 	va = trunc_page(handle);
    317         sz = round_page(handle + size) - va;
    318 
    319 	pmap_kremove(va, sz);
    320 	pmap_update(pmap_kernel());
    321 	uvm_km_free(kernel_map, va, sz, UVM_KMF_VAONLY);
    322 }
    323 
    324 /* ARGSUSED */
    325 int
    326 mvsoc_bs_subregion(void *space, bus_space_handle_t handle,
    327 		       bus_size_t offset, bus_size_t size,
    328 		       bus_space_handle_t *nhandlep)
    329 {
    330 
    331 	*nhandlep = handle + offset;
    332 	return 0;
    333 }
    334 
    335 /* ARGSUSED */
    336 int
    337 mvsoc_bs_alloc(void *space, bus_addr_t reg_start, bus_addr_t reg_end,
    338 	       bus_size_t size, bus_size_t alignment, bus_size_t boundary,
    339 	       int flags, bus_addr_t *addrp, bus_space_handle_t *handlep)
    340 {
    341 
    342 	panic("%s(): not implemented\n", __func__);
    343 }
    344 
    345 /* ARGSUSED */
    346 void
    347 mvsoc_bs_free(void *space, bus_space_handle_t handle, bus_size_t size)
    348 {
    349 
    350 	panic("%s(): not implemented\n", __func__);
    351 }
    352 
    353 /* ARGSUSED */
    354 void
    355 mvsoc_bs_barrier(void *space, bus_space_handle_t handle, bus_size_t offset,
    356 		 bus_size_t length, int flags)
    357 {
    358 
    359 	/* Nothing to do. */
    360 }
    361 
    362 /* ARGSUSED */
    363 void *
    364 mvsoc_bs_vaddr(void *space, bus_space_handle_t handle)
    365 {
    366 
    367 	return (void *)handle;
    368 }
    369