mvsoc_space.c revision 1.9 1 1.9 skrll /* $NetBSD: mvsoc_space.c,v 1.9 2017/03/10 15:44:24 skrll Exp $ */
2 1.1 kiyohara /*
3 1.1 kiyohara * Copyright (c) 2007 KIYOHARA Takashi
4 1.1 kiyohara * All rights reserved.
5 1.1 kiyohara *
6 1.1 kiyohara * Redistribution and use in source and binary forms, with or without
7 1.1 kiyohara * modification, are permitted provided that the following conditions
8 1.1 kiyohara * are met:
9 1.1 kiyohara * 1. Redistributions of source code must retain the above copyright
10 1.1 kiyohara * notice, this list of conditions and the following disclaimer.
11 1.1 kiyohara * 2. Redistributions in binary form must reproduce the above copyright
12 1.1 kiyohara * notice, this list of conditions and the following disclaimer in the
13 1.1 kiyohara * documentation and/or other materials provided with the distribution.
14 1.1 kiyohara *
15 1.1 kiyohara * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16 1.1 kiyohara * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
17 1.1 kiyohara * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
18 1.1 kiyohara * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
19 1.1 kiyohara * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
20 1.1 kiyohara * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
21 1.1 kiyohara * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22 1.1 kiyohara * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
23 1.1 kiyohara * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
24 1.1 kiyohara * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
25 1.1 kiyohara * POSSIBILITY OF SUCH DAMAGE.
26 1.1 kiyohara */
27 1.1 kiyohara
28 1.1 kiyohara #include <sys/cdefs.h>
29 1.9 skrll __KERNEL_RCSID(0, "$NetBSD: mvsoc_space.c,v 1.9 2017/03/10 15:44:24 skrll Exp $");
30 1.1 kiyohara
31 1.1 kiyohara #include "opt_mvsoc.h"
32 1.1 kiyohara #include "mvpex.h"
33 1.1 kiyohara #include "gtpci.h"
34 1.1 kiyohara
35 1.1 kiyohara #include <sys/param.h>
36 1.1 kiyohara #include <sys/systm.h>
37 1.1 kiyohara
38 1.1 kiyohara #include <uvm/uvm_extern.h>
39 1.1 kiyohara
40 1.2 dyoung #include <sys/bus.h>
41 1.1 kiyohara
42 1.1 kiyohara #include <arm/marvell/mvsocreg.h>
43 1.1 kiyohara #include <arm/marvell/mvsocvar.h>
44 1.1 kiyohara
45 1.1 kiyohara
46 1.1 kiyohara /* Proto types for all the bus_space structure functions */
47 1.1 kiyohara bs_protos(mvsoc);
48 1.1 kiyohara bs_protos(generic);
49 1.1 kiyohara bs_protos(generic_armv4);
50 1.1 kiyohara bs_protos(bs_notimpl);
51 1.1 kiyohara
52 1.3 matt #define MVSOC_BUS_SPACE_NORMAL_FUNCS \
53 1.1 kiyohara /* read (single) */ \
54 1.1 kiyohara generic_bs_r_1, \
55 1.1 kiyohara generic_armv4_bs_r_2, \
56 1.1 kiyohara generic_bs_r_4, \
57 1.1 kiyohara bs_notimpl_bs_r_8, \
58 1.1 kiyohara \
59 1.1 kiyohara /* read multiple */ \
60 1.1 kiyohara generic_bs_rm_1, \
61 1.1 kiyohara generic_armv4_bs_rm_2, \
62 1.1 kiyohara generic_bs_rm_4, \
63 1.1 kiyohara bs_notimpl_bs_rm_8, \
64 1.1 kiyohara \
65 1.1 kiyohara /* read region */ \
66 1.1 kiyohara generic_bs_rr_1, \
67 1.1 kiyohara generic_armv4_bs_rr_2, \
68 1.1 kiyohara generic_bs_rr_4, \
69 1.1 kiyohara bs_notimpl_bs_rr_8, \
70 1.1 kiyohara \
71 1.1 kiyohara /* write (single) */ \
72 1.1 kiyohara generic_bs_w_1, \
73 1.1 kiyohara generic_armv4_bs_w_2, \
74 1.1 kiyohara generic_bs_w_4, \
75 1.1 kiyohara bs_notimpl_bs_w_8, \
76 1.1 kiyohara \
77 1.1 kiyohara /* write multiple */ \
78 1.1 kiyohara generic_bs_wm_1, \
79 1.1 kiyohara generic_armv4_bs_wm_2, \
80 1.1 kiyohara generic_bs_wm_4, \
81 1.1 kiyohara bs_notimpl_bs_wm_8, \
82 1.1 kiyohara \
83 1.1 kiyohara /* write region */ \
84 1.1 kiyohara generic_bs_wr_1, \
85 1.1 kiyohara generic_armv4_bs_wr_2, \
86 1.1 kiyohara generic_bs_wr_4, \
87 1.3 matt bs_notimpl_bs_wr_8
88 1.3 matt
89 1.3 matt #define MVSOC_BUS_SPACE_DEFAULT_FUNCS \
90 1.3 matt /* mapping/unmapping */ \
91 1.3 matt mvsoc_bs_map, \
92 1.3 matt mvsoc_bs_unmap, \
93 1.3 matt mvsoc_bs_subregion, \
94 1.3 matt \
95 1.3 matt /* allocation/deallocation */ \
96 1.3 matt mvsoc_bs_alloc, \
97 1.3 matt mvsoc_bs_free, \
98 1.3 matt \
99 1.3 matt /* get kernel virtual address */ \
100 1.3 matt mvsoc_bs_vaddr, \
101 1.3 matt \
102 1.3 matt /* mmap bus space for userland */ \
103 1.3 matt bs_notimpl_bs_mmap, \
104 1.3 matt \
105 1.3 matt /* barrier */ \
106 1.3 matt mvsoc_bs_barrier, \
107 1.3 matt \
108 1.3 matt MVSOC_BUS_SPACE_NORMAL_FUNCS, \
109 1.1 kiyohara \
110 1.1 kiyohara /* set multiple */ \
111 1.1 kiyohara bs_notimpl_bs_sm_1, \
112 1.1 kiyohara bs_notimpl_bs_sm_2, \
113 1.1 kiyohara bs_notimpl_bs_sm_4, \
114 1.1 kiyohara bs_notimpl_bs_sm_8, \
115 1.1 kiyohara \
116 1.1 kiyohara /* set region */ \
117 1.1 kiyohara bs_notimpl_bs_sr_1, \
118 1.1 kiyohara generic_armv4_bs_sr_2, \
119 1.1 kiyohara generic_bs_sr_4, \
120 1.1 kiyohara bs_notimpl_bs_sr_8, \
121 1.1 kiyohara \
122 1.1 kiyohara /* copy */ \
123 1.1 kiyohara bs_notimpl_bs_c_1, \
124 1.1 kiyohara generic_armv4_bs_c_2, \
125 1.1 kiyohara bs_notimpl_bs_c_4, \
126 1.3 matt bs_notimpl_bs_c_8
127 1.1 kiyohara
128 1.1 kiyohara
129 1.1 kiyohara struct bus_space mvsoc_bs_tag = {
130 1.1 kiyohara /* cookie */
131 1.1 kiyohara (void *)0,
132 1.1 kiyohara
133 1.3 matt MVSOC_BUS_SPACE_DEFAULT_FUNCS,
134 1.3 matt #ifdef __BUS_SPACE_HAS_STREAM_METHODS
135 1.3 matt MVSOC_BUS_SPACE_NORMAL_FUNCS,
136 1.3 matt #endif
137 1.1 kiyohara };
138 1.1 kiyohara
139 1.1 kiyohara #if NMVPEX > 0
140 1.1 kiyohara #if defined(ORION)
141 1.1 kiyohara struct bus_space orion_pex0_mem_bs_tag = {
142 1.1 kiyohara /* cookie */
143 1.1 kiyohara (void *)ORION_TAG_PEX0_MEM,
144 1.1 kiyohara
145 1.3 matt MVSOC_BUS_SPACE_DEFAULT_FUNCS,
146 1.3 matt #ifdef __BUS_SPACE_HAS_STREAM_METHODS
147 1.3 matt MVSOC_BUS_SPACE_NORMAL_FUNCS,
148 1.3 matt #endif
149 1.1 kiyohara };
150 1.1 kiyohara struct bus_space orion_pex0_io_bs_tag = {
151 1.1 kiyohara /* cookie */
152 1.1 kiyohara (void *)ORION_TAG_PEX0_IO,
153 1.1 kiyohara
154 1.3 matt MVSOC_BUS_SPACE_DEFAULT_FUNCS,
155 1.3 matt #ifdef __BUS_SPACE_HAS_STREAM_METHODS
156 1.3 matt MVSOC_BUS_SPACE_NORMAL_FUNCS,
157 1.3 matt #endif
158 1.1 kiyohara };
159 1.1 kiyohara struct bus_space orion_pex1_mem_bs_tag = {
160 1.1 kiyohara /* cookie */
161 1.1 kiyohara (void *)ORION_TAG_PEX1_MEM,
162 1.1 kiyohara
163 1.3 matt MVSOC_BUS_SPACE_DEFAULT_FUNCS,
164 1.3 matt #ifdef __BUS_SPACE_HAS_STREAM_METHODS
165 1.3 matt MVSOC_BUS_SPACE_NORMAL_FUNCS,
166 1.3 matt #endif
167 1.1 kiyohara };
168 1.1 kiyohara struct bus_space orion_pex1_io_bs_tag = {
169 1.1 kiyohara /* cookie */
170 1.1 kiyohara (void *)ORION_TAG_PEX1_IO,
171 1.1 kiyohara
172 1.5 matt MVSOC_BUS_SPACE_DEFAULT_FUNCS,
173 1.3 matt #ifdef __BUS_SPACE_HAS_STREAM_METHODS
174 1.3 matt MVSOC_BUS_SPACE_NORMAL_FUNCS,
175 1.3 matt #endif
176 1.1 kiyohara };
177 1.1 kiyohara #endif
178 1.1 kiyohara
179 1.1 kiyohara #if defined(KIRKWOOD)
180 1.1 kiyohara struct bus_space kirkwood_pex_mem_bs_tag = {
181 1.1 kiyohara /* cookie */
182 1.1 kiyohara (void *)KIRKWOOD_TAG_PEX_MEM,
183 1.1 kiyohara
184 1.3 matt MVSOC_BUS_SPACE_DEFAULT_FUNCS,
185 1.3 matt #ifdef __BUS_SPACE_HAS_STREAM_METHODS
186 1.3 matt MVSOC_BUS_SPACE_NORMAL_FUNCS,
187 1.3 matt #endif
188 1.1 kiyohara };
189 1.1 kiyohara struct bus_space kirkwood_pex_io_bs_tag = {
190 1.1 kiyohara /* cookie */
191 1.1 kiyohara (void *)KIRKWOOD_TAG_PEX_IO,
192 1.1 kiyohara
193 1.3 matt MVSOC_BUS_SPACE_DEFAULT_FUNCS,
194 1.3 matt #ifdef __BUS_SPACE_HAS_STREAM_METHODS
195 1.3 matt MVSOC_BUS_SPACE_NORMAL_FUNCS,
196 1.3 matt #endif
197 1.1 kiyohara };
198 1.4 kiyohara struct bus_space kirkwood_pex1_mem_bs_tag = {
199 1.4 kiyohara /* cookie */
200 1.4 kiyohara (void *)KIRKWOOD_TAG_PEX1_MEM,
201 1.4 kiyohara
202 1.5 matt MVSOC_BUS_SPACE_DEFAULT_FUNCS,
203 1.5 matt #ifdef __BUS_SPACE_HAS_STREAM_METHODS
204 1.5 matt MVSOC_BUS_SPACE_NORMAL_FUNCS,
205 1.5 matt #endif
206 1.4 kiyohara };
207 1.4 kiyohara struct bus_space kirkwood_pex1_io_bs_tag = {
208 1.4 kiyohara /* cookie */
209 1.4 kiyohara (void *)KIRKWOOD_TAG_PEX1_IO,
210 1.4 kiyohara
211 1.5 matt MVSOC_BUS_SPACE_DEFAULT_FUNCS,
212 1.5 matt #ifdef __BUS_SPACE_HAS_STREAM_METHODS
213 1.5 matt MVSOC_BUS_SPACE_NORMAL_FUNCS,
214 1.5 matt #endif
215 1.4 kiyohara };
216 1.1 kiyohara #endif
217 1.6 rkujawa
218 1.8 kiyohara #if defined(DOVE)
219 1.8 kiyohara struct bus_space dove_pex0_mem_bs_tag = {
220 1.8 kiyohara /* cookie */
221 1.8 kiyohara (void *)DOVE_TAG_PEX0_MEM,
222 1.8 kiyohara
223 1.8 kiyohara MVSOC_BUS_SPACE_DEFAULT_FUNCS,
224 1.8 kiyohara #ifdef __BUS_SPACE_HAS_STREAM_METHODS
225 1.8 kiyohara MVSOC_BUS_SPACE_NORMAL_FUNCS,
226 1.8 kiyohara #endif
227 1.8 kiyohara };
228 1.8 kiyohara struct bus_space dove_pex0_io_bs_tag = {
229 1.8 kiyohara /* cookie */
230 1.8 kiyohara (void *)DOVE_TAG_PEX0_IO,
231 1.8 kiyohara
232 1.8 kiyohara MVSOC_BUS_SPACE_DEFAULT_FUNCS,
233 1.8 kiyohara #ifdef __BUS_SPACE_HAS_STREAM_METHODS
234 1.8 kiyohara MVSOC_BUS_SPACE_NORMAL_FUNCS,
235 1.8 kiyohara #endif
236 1.8 kiyohara };
237 1.8 kiyohara struct bus_space dove_pex1_mem_bs_tag = {
238 1.8 kiyohara /* cookie */
239 1.8 kiyohara (void *)DOVE_TAG_PEX1_MEM,
240 1.8 kiyohara
241 1.8 kiyohara MVSOC_BUS_SPACE_DEFAULT_FUNCS,
242 1.8 kiyohara #ifdef __BUS_SPACE_HAS_STREAM_METHODS
243 1.8 kiyohara MVSOC_BUS_SPACE_NORMAL_FUNCS,
244 1.8 kiyohara #endif
245 1.8 kiyohara };
246 1.8 kiyohara struct bus_space dove_pex1_io_bs_tag = {
247 1.8 kiyohara /* cookie */
248 1.8 kiyohara (void *)DOVE_TAG_PEX1_IO,
249 1.8 kiyohara
250 1.8 kiyohara MVSOC_BUS_SPACE_DEFAULT_FUNCS,
251 1.8 kiyohara #ifdef __BUS_SPACE_HAS_STREAM_METHODS
252 1.8 kiyohara MVSOC_BUS_SPACE_NORMAL_FUNCS,
253 1.8 kiyohara #endif
254 1.8 kiyohara };
255 1.8 kiyohara #endif
256 1.8 kiyohara
257 1.6 rkujawa #if defined(ARMADAXP)
258 1.6 rkujawa struct bus_space armadaxp_pex00_mem_bs_tag = {
259 1.6 rkujawa /* cookie */
260 1.6 rkujawa (void *)ARMADAXP_TAG_PEX00_MEM,
261 1.6 rkujawa
262 1.6 rkujawa MVSOC_BUS_SPACE_DEFAULT_FUNCS
263 1.6 rkujawa };
264 1.6 rkujawa struct bus_space armadaxp_pex00_io_bs_tag = {
265 1.6 rkujawa /* cookie */
266 1.6 rkujawa (void *)ARMADAXP_TAG_PEX00_IO,
267 1.6 rkujawa
268 1.6 rkujawa MVSOC_BUS_SPACE_DEFAULT_FUNCS
269 1.6 rkujawa };
270 1.6 rkujawa struct bus_space armadaxp_pex01_mem_bs_tag = {
271 1.6 rkujawa /* cookie */
272 1.6 rkujawa (void *)ARMADAXP_TAG_PEX01_MEM,
273 1.6 rkujawa
274 1.6 rkujawa MVSOC_BUS_SPACE_DEFAULT_FUNCS
275 1.6 rkujawa };
276 1.6 rkujawa struct bus_space armadaxp_pex01_io_bs_tag = {
277 1.6 rkujawa /* cookie */
278 1.6 rkujawa (void *)ARMADAXP_TAG_PEX01_IO,
279 1.6 rkujawa
280 1.6 rkujawa MVSOC_BUS_SPACE_DEFAULT_FUNCS
281 1.6 rkujawa };
282 1.6 rkujawa struct bus_space armadaxp_pex02_mem_bs_tag = {
283 1.6 rkujawa /* cookie */
284 1.6 rkujawa (void *)ARMADAXP_TAG_PEX02_MEM,
285 1.6 rkujawa
286 1.6 rkujawa MVSOC_BUS_SPACE_DEFAULT_FUNCS
287 1.6 rkujawa };
288 1.6 rkujawa struct bus_space armadaxp_pex02_io_bs_tag = {
289 1.6 rkujawa /* cookie */
290 1.6 rkujawa (void *)ARMADAXP_TAG_PEX02_IO,
291 1.6 rkujawa
292 1.6 rkujawa MVSOC_BUS_SPACE_DEFAULT_FUNCS
293 1.6 rkujawa };
294 1.6 rkujawa struct bus_space armadaxp_pex03_mem_bs_tag = {
295 1.6 rkujawa /* cookie */
296 1.6 rkujawa (void *)ARMADAXP_TAG_PEX03_MEM,
297 1.6 rkujawa
298 1.6 rkujawa MVSOC_BUS_SPACE_DEFAULT_FUNCS
299 1.6 rkujawa };
300 1.6 rkujawa struct bus_space armadaxp_pex03_io_bs_tag = {
301 1.6 rkujawa /* cookie */
302 1.6 rkujawa (void *)ARMADAXP_TAG_PEX03_IO,
303 1.6 rkujawa
304 1.6 rkujawa MVSOC_BUS_SPACE_DEFAULT_FUNCS
305 1.6 rkujawa };
306 1.9 skrll struct bus_space armadaxp_pex10_mem_bs_tag = {
307 1.9 skrll /* cookie */
308 1.9 skrll (void *)ARMADAXP_TAG_PEX10_MEM,
309 1.9 skrll
310 1.9 skrll MVSOC_BUS_SPACE_DEFAULT_FUNCS
311 1.9 skrll };
312 1.9 skrll struct bus_space armadaxp_pex10_io_bs_tag = {
313 1.9 skrll /* cookie */
314 1.9 skrll (void *)ARMADAXP_TAG_PEX10_IO,
315 1.9 skrll
316 1.9 skrll MVSOC_BUS_SPACE_DEFAULT_FUNCS
317 1.9 skrll };
318 1.6 rkujawa struct bus_space armadaxp_pex2_mem_bs_tag = {
319 1.6 rkujawa /* cookie */
320 1.6 rkujawa (void *)ARMADAXP_TAG_PEX2_MEM,
321 1.6 rkujawa
322 1.6 rkujawa MVSOC_BUS_SPACE_DEFAULT_FUNCS
323 1.6 rkujawa };
324 1.6 rkujawa struct bus_space armadaxp_pex2_io_bs_tag = {
325 1.6 rkujawa /* cookie */
326 1.6 rkujawa (void *)ARMADAXP_TAG_PEX2_IO,
327 1.6 rkujawa
328 1.6 rkujawa MVSOC_BUS_SPACE_DEFAULT_FUNCS
329 1.6 rkujawa };
330 1.6 rkujawa struct bus_space armadaxp_pex3_mem_bs_tag = {
331 1.6 rkujawa /* cookie */
332 1.6 rkujawa (void *)ARMADAXP_TAG_PEX3_MEM,
333 1.6 rkujawa
334 1.6 rkujawa MVSOC_BUS_SPACE_DEFAULT_FUNCS
335 1.6 rkujawa };
336 1.6 rkujawa struct bus_space armadaxp_pex3_io_bs_tag = {
337 1.6 rkujawa /* cookie */
338 1.6 rkujawa (void *)ARMADAXP_TAG_PEX3_IO,
339 1.6 rkujawa
340 1.6 rkujawa MVSOC_BUS_SPACE_DEFAULT_FUNCS
341 1.6 rkujawa };
342 1.6 rkujawa #endif
343 1.1 kiyohara #endif
344 1.1 kiyohara
345 1.1 kiyohara #if NGTPCI > 0
346 1.1 kiyohara #if defined(ORION)
347 1.1 kiyohara struct bus_space orion_pci_mem_bs_tag = {
348 1.1 kiyohara /* cookie */
349 1.1 kiyohara (void *)ORION_TAG_PCI_MEM,
350 1.1 kiyohara
351 1.3 matt MVSOC_BUS_SPACE_DEFAULT_FUNCS,
352 1.3 matt #ifdef __BUS_SPACE_HAS_STREAM_METHODS
353 1.3 matt MVSOC_BUS_SPACE_NORMAL_FUNCS,
354 1.3 matt #endif
355 1.1 kiyohara };
356 1.1 kiyohara struct bus_space orion_pci_io_bs_tag = {
357 1.1 kiyohara /* cookie */
358 1.1 kiyohara (void *)ORION_TAG_PCI_IO,
359 1.1 kiyohara
360 1.3 matt MVSOC_BUS_SPACE_DEFAULT_FUNCS,
361 1.3 matt #ifdef __BUS_SPACE_HAS_STREAM_METHODS
362 1.3 matt MVSOC_BUS_SPACE_NORMAL_FUNCS,
363 1.3 matt #endif
364 1.1 kiyohara };
365 1.1 kiyohara #endif
366 1.1 kiyohara #endif
367 1.1 kiyohara
368 1.1 kiyohara
369 1.1 kiyohara int
370 1.1 kiyohara mvsoc_bs_map(void *space, bus_addr_t address, bus_size_t size, int flags,
371 1.1 kiyohara bus_space_handle_t *handlep)
372 1.1 kiyohara {
373 1.1 kiyohara const struct pmap_devmap *pd;
374 1.1 kiyohara paddr_t startpa, endpa, offset, pa;
375 1.1 kiyohara vaddr_t va;
376 1.6 rkujawa
377 1.6 rkujawa /*
378 1.6 rkujawa * XXX: We are not configuring any decode windows for Armada XP
379 1.6 rkujawa * at the moment. We rely on those that have been set by u-boot.
380 1.6 rkujawa * Hence we don't want to mess around with decode windows,
381 1.6 rkujawa * till we get full controll over them.
382 1.6 rkujawa */
383 1.6 rkujawa
384 1.1 kiyohara int tag = (int)space;
385 1.1 kiyohara
386 1.1 kiyohara if (tag != 0) {
387 1.1 kiyohara bus_addr_t remap;
388 1.1 kiyohara uint32_t base;
389 1.1 kiyohara int window;
390 1.1 kiyohara
391 1.1 kiyohara window = mvsoc_target(tag, NULL, NULL, &base, NULL);
392 1.1 kiyohara if (window == -1)
393 1.1 kiyohara return ENOMEM;
394 1.1 kiyohara if (window < nremap) {
395 1.1 kiyohara remap = read_mlmbreg(MVSOC_MLMB_WRLR(window)) &
396 1.1 kiyohara MVSOC_MLMB_WRLR_REMAP_MASK;
397 1.1 kiyohara remap |=
398 1.1 kiyohara (read_mlmbreg(MVSOC_MLMB_WRHR(window)) << 16) << 16;
399 1.1 kiyohara address = address - remap + base;
400 1.1 kiyohara }
401 1.1 kiyohara }
402 1.1 kiyohara
403 1.1 kiyohara if ((pd = pmap_devmap_find_pa(address, size)) != NULL) {
404 1.1 kiyohara /* Device was statically mapped. */
405 1.1 kiyohara *handlep = pd->pd_va + (address - pd->pd_pa);
406 1.1 kiyohara return 0;
407 1.1 kiyohara }
408 1.1 kiyohara
409 1.1 kiyohara startpa = trunc_page(address);
410 1.1 kiyohara endpa = round_page(address + size);
411 1.1 kiyohara offset = address & PAGE_MASK;
412 1.1 kiyohara
413 1.1 kiyohara /* XXX use extent manager to check duplicate mapping */
414 1.1 kiyohara
415 1.1 kiyohara va = uvm_km_alloc(kernel_map, endpa - startpa, 0,
416 1.1 kiyohara UVM_KMF_VAONLY | UVM_KMF_NOWAIT);
417 1.1 kiyohara if (va == 0x00000000)
418 1.1 kiyohara return ENOMEM;
419 1.1 kiyohara
420 1.1 kiyohara *handlep = va + offset;
421 1.1 kiyohara
422 1.7 matt const int pmapflags =
423 1.7 matt (flags & (BUS_SPACE_MAP_CACHEABLE|BUS_SPACE_MAP_PREFETCHABLE))
424 1.7 matt ? 0
425 1.7 matt : PMAP_NOCACHE;
426 1.7 matt
427 1.1 kiyohara /* Now map the pages */
428 1.1 kiyohara for (pa = startpa; pa < endpa; pa += PAGE_SIZE, va += PAGE_SIZE) {
429 1.7 matt pmap_kenter_pa(va, pa, VM_PROT_READ | VM_PROT_WRITE, pmapflags);
430 1.1 kiyohara }
431 1.1 kiyohara pmap_update(pmap_kernel());
432 1.1 kiyohara
433 1.1 kiyohara return 0;
434 1.1 kiyohara }
435 1.1 kiyohara
436 1.1 kiyohara void
437 1.1 kiyohara mvsoc_bs_unmap(void *space, bus_space_handle_t handle, bus_size_t size)
438 1.1 kiyohara {
439 1.1 kiyohara vaddr_t va, sz;
440 1.1 kiyohara
441 1.1 kiyohara if (pmap_devmap_find_va(handle, size) != NULL)
442 1.1 kiyohara /* Device was statically mapped; nothing to do. */
443 1.1 kiyohara return;
444 1.1 kiyohara
445 1.1 kiyohara va = trunc_page(handle);
446 1.1 kiyohara sz = round_page(handle + size) - va;
447 1.1 kiyohara
448 1.1 kiyohara pmap_kremove(va, sz);
449 1.1 kiyohara pmap_update(pmap_kernel());
450 1.1 kiyohara uvm_km_free(kernel_map, va, sz, UVM_KMF_VAONLY);
451 1.1 kiyohara }
452 1.1 kiyohara
453 1.1 kiyohara /* ARGSUSED */
454 1.1 kiyohara int
455 1.1 kiyohara mvsoc_bs_subregion(void *space, bus_space_handle_t handle,
456 1.1 kiyohara bus_size_t offset, bus_size_t size,
457 1.1 kiyohara bus_space_handle_t *nhandlep)
458 1.1 kiyohara {
459 1.1 kiyohara
460 1.1 kiyohara *nhandlep = handle + offset;
461 1.1 kiyohara return 0;
462 1.1 kiyohara }
463 1.1 kiyohara
464 1.1 kiyohara /* ARGSUSED */
465 1.1 kiyohara int
466 1.1 kiyohara mvsoc_bs_alloc(void *space, bus_addr_t reg_start, bus_addr_t reg_end,
467 1.1 kiyohara bus_size_t size, bus_size_t alignment, bus_size_t boundary,
468 1.1 kiyohara int flags, bus_addr_t *addrp, bus_space_handle_t *handlep)
469 1.1 kiyohara {
470 1.1 kiyohara
471 1.1 kiyohara panic("%s(): not implemented\n", __func__);
472 1.1 kiyohara }
473 1.1 kiyohara
474 1.1 kiyohara /* ARGSUSED */
475 1.1 kiyohara void
476 1.1 kiyohara mvsoc_bs_free(void *space, bus_space_handle_t handle, bus_size_t size)
477 1.1 kiyohara {
478 1.1 kiyohara
479 1.1 kiyohara panic("%s(): not implemented\n", __func__);
480 1.1 kiyohara }
481 1.1 kiyohara
482 1.1 kiyohara /* ARGSUSED */
483 1.1 kiyohara void
484 1.1 kiyohara mvsoc_bs_barrier(void *space, bus_space_handle_t handle, bus_size_t offset,
485 1.1 kiyohara bus_size_t length, int flags)
486 1.1 kiyohara {
487 1.1 kiyohara
488 1.1 kiyohara /* Nothing to do. */
489 1.1 kiyohara }
490 1.1 kiyohara
491 1.1 kiyohara /* ARGSUSED */
492 1.1 kiyohara void *
493 1.1 kiyohara mvsoc_bs_vaddr(void *space, bus_space_handle_t handle)
494 1.1 kiyohara {
495 1.1 kiyohara
496 1.1 kiyohara return (void *)handle;
497 1.1 kiyohara }
498