bcm53xx_board.c revision 1.9 1 1.9 matt /* $NetBSD: bcm53xx_board.c,v 1.9 2013/01/10 22:06:32 matt Exp $ */
2 1.1 matt /*-
3 1.1 matt * Copyright (c) 2012 The NetBSD Foundation, Inc.
4 1.1 matt * All rights reserved.
5 1.1 matt *
6 1.1 matt * This code is derived from software contributed to The NetBSD Foundation
7 1.1 matt * by Matt Thomas of 3am Software Foundry.
8 1.1 matt *
9 1.1 matt * Redistribution and use in source and binary forms, with or without
10 1.1 matt * modification, are permitted provided that the following conditions
11 1.1 matt * are met:
12 1.1 matt * 1. Redistributions of source code must retain the above copyright
13 1.1 matt * notice, this list of conditions and the following disclaimer.
14 1.1 matt * 2. Redistributions in binary form must reproduce the above copyright
15 1.1 matt * notice, this list of conditions and the following disclaimer in the
16 1.1 matt * documentation and/or other materials provided with the distribution.
17 1.1 matt *
18 1.1 matt * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
19 1.1 matt * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
20 1.1 matt * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
21 1.1 matt * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
22 1.1 matt * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23 1.1 matt * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24 1.1 matt * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25 1.1 matt * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26 1.1 matt * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27 1.1 matt * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28 1.1 matt * POSSIBILITY OF SUCH DAMAGE.
29 1.1 matt */
30 1.1 matt
31 1.1 matt #include "opt_broadcom.h"
32 1.1 matt
33 1.1 matt #define _ARM32_BUS_DMA_PRIVATE
34 1.1 matt
35 1.1 matt #include <sys/cdefs.h>
36 1.1 matt
37 1.9 matt __KERNEL_RCSID(1, "$NetBSD: bcm53xx_board.c,v 1.9 2013/01/10 22:06:32 matt Exp $");
38 1.1 matt
39 1.1 matt #include <sys/param.h>
40 1.1 matt #include <sys/bus.h>
41 1.1 matt #include <sys/cpu.h>
42 1.1 matt #include <sys/device.h>
43 1.1 matt
44 1.1 matt #include <prop/proplib.h>
45 1.1 matt
46 1.4 matt #include <net/if.h>
47 1.4 matt #include <net/if_ether.h>
48 1.4 matt
49 1.1 matt #define CRU_PRIVATE
50 1.1 matt #define DDR_PRIVATE
51 1.1 matt #define DMU_PRIVATE
52 1.1 matt #define ARMCORE_PRIVATE
53 1.4 matt #define SRAB_PRIVATE
54 1.1 matt
55 1.1 matt #include <arm/cortex/a9tmr_var.h>
56 1.2 matt #include <arm/cortex/pl310_var.h>
57 1.1 matt #include <arm/mainbus/mainbus.h>
58 1.1 matt
59 1.1 matt #include <arm/broadcom/bcm53xx_reg.h>
60 1.1 matt #include <arm/broadcom/bcm53xx_var.h>
61 1.1 matt
62 1.1 matt bus_space_tag_t bcm53xx_ioreg_bst = &bcmgen_bs_tag;
63 1.1 matt bus_space_handle_t bcm53xx_ioreg_bsh;
64 1.1 matt bus_space_tag_t bcm53xx_armcore_bst = &bcmgen_bs_tag;
65 1.1 matt bus_space_handle_t bcm53xx_armcore_bsh;
66 1.1 matt
67 1.1 matt static struct cpu_softc cpu_softc;
68 1.1 matt
69 1.8 matt struct arm32_dma_range bcm53xx_dma_ranges[2] = {
70 1.8 matt [0] = {
71 1.8 matt .dr_sysbase = 0x80000000,
72 1.8 matt .dr_busbase = 0x80000000,
73 1.8 matt .dr_len = 0x10000000,
74 1.8 matt }, [1] = {
75 1.8 matt .dr_sysbase = 0x90000000,
76 1.8 matt .dr_busbase = 0x90000000,
77 1.8 matt },
78 1.8 matt };
79 1.5 matt
80 1.1 matt struct arm32_bus_dma_tag bcm53xx_dma_tag = {
81 1.8 matt ._ranges = bcm53xx_dma_ranges,
82 1.8 matt ._nranges = __arraycount(bcm53xx_dma_ranges),
83 1.3 matt _BUS_DMAMAP_FUNCS,
84 1.3 matt _BUS_DMAMEM_FUNCS,
85 1.3 matt _BUS_DMATAG_FUNCS,
86 1.1 matt };
87 1.1 matt
88 1.8 matt struct arm32_dma_range bcm53xx_coherent_dma_ranges[2] = {
89 1.8 matt [0] = {
90 1.8 matt .dr_sysbase = 0x80000000,
91 1.8 matt .dr_busbase = 0x80000000,
92 1.8 matt .dr_len = 0x10000000,
93 1.8 matt .dr_flags = _BUS_DMAMAP_COHERENT,
94 1.8 matt }, [1] = {
95 1.8 matt .dr_sysbase = 0x90000000,
96 1.8 matt .dr_busbase = 0x90000000,
97 1.8 matt },
98 1.8 matt };
99 1.6 matt
100 1.6 matt struct arm32_bus_dma_tag bcm53xx_coherent_dma_tag = {
101 1.8 matt ._ranges = bcm53xx_coherent_dma_ranges,
102 1.8 matt ._nranges = __arraycount(bcm53xx_coherent_dma_ranges),
103 1.6 matt _BUS_DMAMAP_FUNCS,
104 1.6 matt _BUS_DMAMEM_FUNCS,
105 1.6 matt _BUS_DMATAG_FUNCS,
106 1.6 matt };
107 1.6 matt
108 1.1 matt #ifdef BCM53XX_CONSOLE_EARLY
109 1.1 matt #include <dev/ic/ns16550reg.h>
110 1.1 matt #include <dev/ic/comreg.h>
111 1.1 matt #include <dev/cons.h>
112 1.1 matt
113 1.1 matt static vaddr_t com_base;
114 1.1 matt
115 1.1 matt static inline uint32_t
116 1.1 matt uart_read(bus_size_t o)
117 1.1 matt {
118 1.1 matt return *(volatile uint8_t *)(com_base + o);
119 1.1 matt }
120 1.1 matt
121 1.1 matt static inline void
122 1.1 matt uart_write(bus_size_t o, uint32_t v)
123 1.1 matt {
124 1.1 matt *(volatile uint8_t *)(com_base + o) = v;
125 1.1 matt }
126 1.1 matt
127 1.1 matt static int
128 1.1 matt bcm53xx_cngetc(dev_t dv)
129 1.1 matt {
130 1.1 matt if ((uart_read(com_lsr) & LSR_RXRDY) == 0)
131 1.1 matt return -1;
132 1.1 matt
133 1.1 matt return uart_read(com_data) & 0xff;
134 1.1 matt }
135 1.1 matt
136 1.1 matt static void
137 1.1 matt bcm53xx_cnputc(dev_t dv, int c)
138 1.1 matt {
139 1.1 matt int timo = 150000;
140 1.1 matt
141 1.1 matt while ((uart_read(com_lsr) & LSR_TXRDY) == 0 && --timo > 0)
142 1.1 matt ;
143 1.1 matt
144 1.1 matt uart_write(com_data, c);
145 1.1 matt
146 1.1 matt timo = 150000;
147 1.1 matt while ((uart_read(com_lsr) & LSR_TSRE) == 0 && --timo > 0)
148 1.1 matt ;
149 1.1 matt }
150 1.1 matt
151 1.1 matt static struct consdev bcm53xx_earlycons = {
152 1.1 matt .cn_putc = bcm53xx_cnputc,
153 1.1 matt .cn_getc = bcm53xx_cngetc,
154 1.1 matt .cn_pollc = nullcnpollc,
155 1.1 matt };
156 1.1 matt #endif /* BCM53XX_CONSOLE_EARLY */
157 1.1 matt
158 1.1 matt psize_t
159 1.1 matt bcm53xx_memprobe(void)
160 1.1 matt {
161 1.1 matt bus_space_tag_t bst = bcm53xx_ioreg_bst;
162 1.1 matt bus_space_handle_t bsh = bcm53xx_ioreg_bsh;
163 1.1 matt
164 1.1 matt /*
165 1.1 matt * First, let's read the magic DDR registers!
166 1.1 matt */
167 1.1 matt const uint32_t v01 = bus_space_read_4(bst, bsh, DDR_BASE + DDR_CTL_01);
168 1.1 matt const uint32_t v82 = bus_space_read_4(bst, bsh, DDR_BASE + DDR_CTL_82);
169 1.1 matt const uint32_t v86 = bus_space_read_4(bst, bsh, DDR_BASE + DDR_CTL_86);
170 1.1 matt const uint32_t v87 = bus_space_read_4(bst, bsh, DDR_BASE + DDR_CTL_87);
171 1.1 matt
172 1.1 matt /*
173 1.1 matt * Calculate chip parameters
174 1.1 matt * */
175 1.1 matt const u_int rows = __SHIFTOUT(v01, CTL_01_MAX_ROW)
176 1.1 matt - __SHIFTOUT(v82, CTL_82_ROW_DIFF);
177 1.1 matt const u_int cols = __SHIFTOUT(v01, CTL_01_MAX_COL)
178 1.1 matt - __SHIFTOUT(v82, CTL_82_COL_DIFF);
179 1.1 matt const u_int banks_log2 = 3 - __SHIFTOUT(v82, CTL_82_BANK_DIFF);
180 1.1 matt
181 1.1 matt /*
182 1.1 matt * For each chip select, increase the chip count if if is enabled.
183 1.1 matt */
184 1.1 matt const u_int max_chips = __SHIFTOUT(v01, CTL_01_MAX_CHIP_SEL);
185 1.1 matt u_int cs_map = __SHIFTOUT(v86, CTL_86_CS_MAP);
186 1.1 matt u_int chips = 0;
187 1.1 matt
188 1.1 matt for (u_int i = 0; cs_map != 0 && i < max_chips; i++, cs_map >>= 1) {
189 1.1 matt chips += (cs_map & 1);
190 1.1 matt }
191 1.1 matt
192 1.1 matt /* get log2(ddr width) */
193 1.1 matt
194 1.1 matt const u_int ddr_width_log2 = (v87 & CTL_87_REDUC) ? 1 : 2;
195 1.1 matt
196 1.1 matt /*
197 1.1 matt * Let's add up all the things that contribute to the size of a chip.
198 1.1 matt */
199 1.1 matt const u_int chip_size_log2 = cols + rows + banks_log2 + ddr_width_log2;
200 1.1 matt
201 1.1 matt /*
202 1.1 matt * Now our memory size is simply the number of chip shifted by the
203 1.1 matt * log2(chip_size).
204 1.1 matt */
205 1.1 matt return (psize_t) chips << chip_size_log2;
206 1.1 matt }
207 1.1 matt
208 1.1 matt static inline uint32_t
209 1.1 matt bcm53xx_freq_calc(struct bcm53xx_clock_info *clk,
210 1.1 matt uint32_t pdiv, uint32_t ndiv_int, uint32_t ndiv_frac)
211 1.1 matt {
212 1.1 matt if (ndiv_frac == 0 && pdiv == 1)
213 1.1 matt return ndiv_int * clk->clk_ref;
214 1.1 matt
215 1.1 matt uint64_t freq64 = ((uint64_t)ndiv_int << 30) + ndiv_frac;
216 1.1 matt freq64 *= clk->clk_ref;
217 1.1 matt if (pdiv > 1)
218 1.1 matt freq64 /= pdiv;
219 1.1 matt return (uint32_t) (freq64 >> 30);
220 1.1 matt }
221 1.1 matt
222 1.1 matt static uint32_t
223 1.1 matt bcm53xx_value_wrap(uint32_t value, uint32_t mask)
224 1.1 matt {
225 1.1 matt /*
226 1.1 matt * n is n except when n is 0 then n = mask + 1.
227 1.1 matt */
228 1.1 matt return ((__SHIFTOUT(value, mask) - 1) & __SHIFTOUT(mask, mask)) + 1;
229 1.1 matt }
230 1.1 matt
231 1.1 matt static void
232 1.1 matt bcm53xx_genpll_clock_init(struct bcm53xx_clock_info *clk, uint32_t control5,
233 1.1 matt uint32_t control6, uint32_t control7)
234 1.1 matt {
235 1.1 matt const uint32_t pdiv = bcm53xx_value_wrap(control6,
236 1.1 matt GENPLL_CONTROL6_PDIV);
237 1.1 matt const uint32_t ndiv_int = bcm53xx_value_wrap(control5,
238 1.1 matt GENPLL_CONTROL5_NDIV_INT);
239 1.1 matt const uint32_t ndiv_frac = __SHIFTOUT(control5,
240 1.1 matt GENPLL_CONTROL5_NDIV_FRAC);
241 1.1 matt
242 1.1 matt clk->clk_genpll = bcm53xx_freq_calc(clk, pdiv, ndiv_int, ndiv_frac);
243 1.1 matt
244 1.1 matt const uint32_t ch0_mdiv = bcm53xx_value_wrap(control6,
245 1.1 matt GENPLL_CONTROL6_CH0_MDIV);
246 1.1 matt const uint32_t ch1_mdiv = bcm53xx_value_wrap(control6,
247 1.1 matt GENPLL_CONTROL6_CH1_MDIV);
248 1.1 matt const uint32_t ch2_mdiv = bcm53xx_value_wrap(control6,
249 1.1 matt GENPLL_CONTROL6_CH2_MDIV);
250 1.1 matt const uint32_t ch3_mdiv = bcm53xx_value_wrap(control7,
251 1.1 matt GENPLL_CONTROL7_CH3_MDIV);
252 1.1 matt
253 1.1 matt clk->clk_mac = clk->clk_genpll / ch0_mdiv; // GENPLL CH0
254 1.1 matt clk->clk_robo = clk->clk_genpll / ch1_mdiv; // GENPLL CH1
255 1.1 matt clk->clk_usb2 = clk->clk_genpll / ch2_mdiv; // GENPLL CH2
256 1.1 matt clk->clk_iproc = clk->clk_genpll / ch3_mdiv; // GENPLL CH3
257 1.1 matt }
258 1.1 matt
259 1.1 matt static void
260 1.1 matt bcm53xx_lcpll_clock_init(struct bcm53xx_clock_info *clk, uint32_t control1,
261 1.1 matt uint32_t control2)
262 1.1 matt {
263 1.1 matt const uint32_t pdiv = bcm53xx_value_wrap(control1,
264 1.1 matt LCPLL_CONTROL1_PDIV);
265 1.1 matt const uint32_t ndiv_int = bcm53xx_value_wrap(control1,
266 1.1 matt LCPLL_CONTROL1_NDIV_INT);
267 1.1 matt const uint32_t ndiv_frac = __SHIFTOUT(control1,
268 1.1 matt LCPLL_CONTROL1_NDIV_FRAC);
269 1.1 matt
270 1.1 matt clk->clk_lcpll = bcm53xx_freq_calc(clk, pdiv, ndiv_int, ndiv_frac);
271 1.1 matt
272 1.1 matt const uint32_t ch0_mdiv = bcm53xx_value_wrap(control2,
273 1.1 matt LCPLL_CONTROL2_CH0_MDIV);
274 1.1 matt const uint32_t ch1_mdiv = bcm53xx_value_wrap(control2,
275 1.1 matt LCPLL_CONTROL2_CH1_MDIV);
276 1.1 matt const uint32_t ch2_mdiv = bcm53xx_value_wrap(control2,
277 1.1 matt LCPLL_CONTROL2_CH2_MDIV);
278 1.1 matt const uint32_t ch3_mdiv = bcm53xx_value_wrap(control2,
279 1.1 matt LCPLL_CONTROL2_CH3_MDIV);
280 1.1 matt
281 1.1 matt clk->clk_pcie_ref = clk->clk_lcpll / ch0_mdiv; // LCPLL CH0
282 1.1 matt clk->clk_sdio = clk->clk_lcpll / ch1_mdiv; // LCPLL CH1
283 1.1 matt clk->clk_ddr_ref = clk->clk_lcpll / ch2_mdiv; // LCPLL CH2
284 1.1 matt clk->clk_axi = clk->clk_lcpll / ch3_mdiv; // LCPLL CH3
285 1.1 matt }
286 1.1 matt
287 1.1 matt static void
288 1.1 matt bcm53xx_usb_clock_init(struct bcm53xx_clock_info *clk, uint32_t usb2_control)
289 1.1 matt {
290 1.1 matt const uint32_t pdiv = bcm53xx_value_wrap(usb2_control,
291 1.1 matt USB2_CONTROL_PDIV);
292 1.1 matt const uint32_t ndiv = bcm53xx_value_wrap(usb2_control,
293 1.1 matt USB2_CONTROL_NDIV_INT);
294 1.1 matt
295 1.1 matt uint32_t usb_ref = (clk->clk_usb2 / pdiv) * ndiv;
296 1.1 matt if (usb_ref != USB2_REF_CLK) {
297 1.1 matt /*
298 1.1 matt * USB Reference Clock isn't 1.92GHz. So we need to modify
299 1.1 matt * USB2_CONTROL to produce it.
300 1.1 matt */
301 1.1 matt uint32_t new_ndiv = (USB2_REF_CLK / clk->clk_usb2) * pdiv;
302 1.1 matt usb2_control &= ~USB2_CONTROL_NDIV_INT;
303 1.1 matt usb2_control |= __SHIFTIN(new_ndiv, USB2_CONTROL_NDIV_INT);
304 1.1 matt
305 1.1 matt // Allow Clocks to be modified
306 1.1 matt bus_space_write_4(bcm53xx_ioreg_bst, bcm53xx_ioreg_bsh,
307 1.1 matt CRU_BASE + CRU_CLKSET_KEY, CRU_CLKSET_KEY_MAGIC);
308 1.1 matt
309 1.1 matt // Update USB2 clock generator
310 1.1 matt bus_space_write_4(bcm53xx_ioreg_bst, bcm53xx_ioreg_bsh,
311 1.1 matt CRU_BASE + CRU_USB2_CONTROL, usb2_control);
312 1.1 matt
313 1.1 matt // Prevent Clock modification
314 1.1 matt bus_space_write_4(bcm53xx_ioreg_bst, bcm53xx_ioreg_bsh,
315 1.1 matt CRU_BASE + CRU_CLKSET_KEY, 0);
316 1.1 matt
317 1.1 matt usb_ref = (clk->clk_usb2 / pdiv) * new_ndiv;
318 1.1 matt }
319 1.1 matt
320 1.1 matt clk->clk_usb_ref = usb_ref;
321 1.1 matt }
322 1.1 matt
323 1.1 matt
324 1.1 matt static void
325 1.1 matt bcm53xx_clock_init(struct bcm53xx_clock_info *clk)
326 1.1 matt {
327 1.1 matt clk->clk_ref = BCM53XX_REF_CLK;
328 1.1 matt clk->clk_sys = 8*clk->clk_ref;
329 1.1 matt }
330 1.1 matt
331 1.1 matt /*
332 1.1 matt * F(ddr) = ((1 / pdiv) * ndiv * CH2) / (post_div * 2)
333 1.1 matt */
334 1.1 matt static void
335 1.1 matt bcm53xx_get_ddr_freq(struct bcm53xx_clock_info *clk, uint32_t pll_status,
336 1.1 matt uint32_t pll_dividers)
337 1.1 matt {
338 1.1 matt const bool clocking_4x = (pll_status & PLL_STATUS_CLOCKING_4X) != 0;
339 1.1 matt u_int post_div = __SHIFTOUT(pll_dividers, PLL_DIVIDERS_POST_DIV);
340 1.1 matt u_int pdiv = __SHIFTOUT(pll_dividers, PLL_DIVIDERS_PDIV);
341 1.1 matt u_int ndiv = __SHIFTOUT(pll_dividers, PLL_DIVIDERS_NDIV);
342 1.1 matt
343 1.1 matt pdiv = ((pdiv - (clocking_4x ? 1 : 5)) & 7) + 1;
344 1.1 matt
345 1.1 matt clk->clk_ddr_mhz = __SHIFTOUT(pll_status, PLL_STATUS_MHZ);
346 1.1 matt clk->clk_ddr = (clk->clk_ddr_ref / pdiv) * ndiv / (2 + post_div);
347 1.1 matt }
348 1.1 matt
349 1.1 matt /*
350 1.1 matt * CPU_CLK = (1 / pdiv) * (ndiv_int + (ndiv_frac / 0x40000000)) x F(ref)
351 1.1 matt */
352 1.1 matt static void
353 1.1 matt bcm53xx_get_cpu_freq(struct bcm53xx_clock_info *clk,
354 1.1 matt uint32_t pllarma, uint32_t pllarmb, uint32_t policy)
355 1.1 matt {
356 1.1 matt policy = __SHIFTOUT(policy, CLK_POLICY_FREQ_POLICY2);
357 1.1 matt
358 1.1 matt if (policy == CLK_POLICY_REF_CLK) {
359 1.1 matt clk->clk_cpu = clk->clk_ref;
360 1.1 matt clk->clk_apb = clk->clk_cpu;
361 1.1 matt return;
362 1.1 matt }
363 1.1 matt
364 1.1 matt if (policy == CLK_POLICY_SYS_CLK) {
365 1.1 matt clk->clk_cpu = clk->clk_sys;
366 1.1 matt clk->clk_apb = clk->clk_cpu / 4;
367 1.1 matt return;
368 1.1 matt }
369 1.1 matt
370 1.1 matt const u_int pdiv = bcm53xx_value_wrap(pllarma, CLK_PLLARMA_PDIV);
371 1.1 matt const u_int ndiv_int = bcm53xx_value_wrap(pllarma, CLK_PLLARMA_NDIV_INT);
372 1.1 matt const u_int ndiv_frac = __SHIFTOUT(pllarmb, CLK_PLLARMB_NDIV_FRAC);
373 1.1 matt // const u_int apb_clk_div = __SHIFTOUT(apb_clk_div, CLK_APB_DIV_VALUE)+1;
374 1.1 matt
375 1.1 matt const u_int cpu_div = (policy == CLK_POLICY_ARM_PLL_CH0) ? 4 : 2;
376 1.1 matt
377 1.1 matt clk->clk_cpu = bcm53xx_freq_calc(clk, pdiv, ndiv_int, ndiv_frac) / cpu_div;
378 1.1 matt clk->clk_apb = clk->clk_cpu / 4;
379 1.1 matt }
380 1.1 matt
381 1.1 matt struct bcm53xx_chip_state {
382 1.1 matt uint32_t bcs_lcpll_control1;
383 1.1 matt uint32_t bcs_lcpll_control2;
384 1.1 matt
385 1.1 matt uint32_t bcs_genpll_control5;
386 1.1 matt uint32_t bcs_genpll_control6;
387 1.1 matt uint32_t bcs_genpll_control7;
388 1.1 matt
389 1.1 matt uint32_t bcs_usb2_control;
390 1.1 matt
391 1.1 matt uint32_t bcs_ddr_phy_ctl_pll_status;
392 1.1 matt uint32_t bcs_ddr_phy_ctl_pll_dividers;
393 1.1 matt
394 1.1 matt uint32_t bcs_armcore_clk_policy;
395 1.1 matt uint32_t bcs_armcore_clk_pllarma;
396 1.1 matt uint32_t bcs_armcore_clk_pllarmb;
397 1.1 matt };
398 1.1 matt
399 1.1 matt static void
400 1.1 matt bcm53xx_get_chip_ioreg_state(struct bcm53xx_chip_state *bcs,
401 1.1 matt bus_space_tag_t bst, bus_space_handle_t bsh)
402 1.1 matt {
403 1.1 matt bcs->bcs_lcpll_control1 = bus_space_read_4(bst, bsh,
404 1.1 matt DMU_BASE + DMU_LCPLL_CONTROL1);
405 1.1 matt bcs->bcs_lcpll_control2 = bus_space_read_4(bst, bsh,
406 1.1 matt DMU_BASE + DMU_LCPLL_CONTROL2);
407 1.1 matt
408 1.1 matt bcs->bcs_genpll_control5 = bus_space_read_4(bst, bsh,
409 1.1 matt CRU_BASE + CRU_GENPLL_CONTROL5);
410 1.1 matt bcs->bcs_genpll_control6 = bus_space_read_4(bst, bsh,
411 1.1 matt CRU_BASE + CRU_GENPLL_CONTROL6);
412 1.1 matt bcs->bcs_genpll_control7 = bus_space_read_4(bst, bsh,
413 1.1 matt CRU_BASE + CRU_GENPLL_CONTROL7);
414 1.1 matt
415 1.1 matt bcs->bcs_usb2_control = bus_space_read_4(bst, bsh,
416 1.1 matt CRU_BASE + CRU_USB2_CONTROL);
417 1.1 matt
418 1.1 matt bcs->bcs_ddr_phy_ctl_pll_status = bus_space_read_4(bst, bsh,
419 1.1 matt DDR_BASE + DDR_PHY_CTL_PLL_STATUS);
420 1.1 matt bcs->bcs_ddr_phy_ctl_pll_dividers = bus_space_read_4(bst, bsh,
421 1.1 matt DDR_BASE + DDR_PHY_CTL_PLL_DIVIDERS);
422 1.1 matt }
423 1.1 matt
424 1.1 matt static void
425 1.1 matt bcm53xx_get_chip_armcore_state(struct bcm53xx_chip_state *bcs,
426 1.1 matt bus_space_tag_t bst, bus_space_handle_t bsh)
427 1.1 matt {
428 1.1 matt bcs->bcs_armcore_clk_policy = bus_space_read_4(bst, bsh,
429 1.1 matt ARMCORE_CLK_POLICY_FREQ);
430 1.1 matt bcs->bcs_armcore_clk_pllarma = bus_space_read_4(bst, bsh,
431 1.1 matt ARMCORE_CLK_PLLARMA);
432 1.1 matt bcs->bcs_armcore_clk_pllarmb = bus_space_read_4(bst, bsh,
433 1.1 matt ARMCORE_CLK_PLLARMB);
434 1.1 matt }
435 1.1 matt
436 1.1 matt void
437 1.1 matt bcm53xx_cpu_softc_init(struct cpu_info *ci)
438 1.1 matt {
439 1.1 matt struct cpu_softc * const cpu = ci->ci_softc;
440 1.1 matt
441 1.1 matt cpu->cpu_ioreg_bst = bcm53xx_ioreg_bst;
442 1.1 matt cpu->cpu_ioreg_bsh = bcm53xx_ioreg_bsh;
443 1.1 matt
444 1.1 matt cpu->cpu_armcore_bst = bcm53xx_armcore_bst;
445 1.1 matt cpu->cpu_armcore_bsh = bcm53xx_armcore_bsh;
446 1.1 matt }
447 1.1 matt
448 1.1 matt void
449 1.1 matt bcm53xx_print_clocks(void)
450 1.1 matt {
451 1.1 matt #if defined(VERBOSE_ARM_INIT)
452 1.9 matt const struct bcm53xx_clock_info * const clk = &cpu_softc.cpu_clk;
453 1.9 matt printf("ref clk = %u (%#x)\n", clk->clk_ref, clk->clk_ref);
454 1.9 matt printf("sys clk = %u (%#x)\n", clk->clk_sys, clk->clk_sys);
455 1.9 matt printf("lcpll clk = %u (%#x)\n", clk->clk_lcpll, clk->clk_lcpll);
456 1.9 matt printf("pcie ref clk = %u (%#x) [CH0]\n", clk->clk_pcie_ref, clk->clk_pcie_ref);
457 1.9 matt printf("sdio clk = %u (%#x) [CH1]\n", clk->clk_sdio, clk->clk_sdio);
458 1.9 matt printf("ddr ref clk = %u (%#x) [CH2]\n", clk->clk_ddr_ref, clk->clk_ddr_ref);
459 1.9 matt printf("axi clk = %u (%#x) [CH3]\n", clk->clk_axi, clk->clk_axi);
460 1.9 matt printf("genpll clk = %u (%#x)\n", clk->clk_genpll, clk->clk_genpll);
461 1.9 matt printf("mac clk = %u (%#x) [CH0]\n", clk->clk_mac, clk->clk_mac);
462 1.9 matt printf("robo clk = %u (%#x) [CH1]\n", clk->clk_robo, clk->clk_robo);
463 1.9 matt printf("usb2 clk = %u (%#x) [CH2]\n", clk->clk_usb2, clk->clk_usb2);
464 1.9 matt printf("iproc clk = %u (%#x) [CH3]\n", clk->clk_iproc, clk->clk_iproc);
465 1.9 matt printf("ddr clk = %u (%#x)\n", clk->clk_ddr, clk->clk_ddr);
466 1.9 matt printf("ddr mhz = %u (%#x)\n", clk->clk_ddr_mhz, clk->clk_ddr_mhz);
467 1.9 matt printf("cpu clk = %u (%#x)\n", clk->clk_cpu, clk->clk_cpu);
468 1.9 matt printf("apb clk = %u (%#x)\n", clk->clk_apb, clk->clk_apb);
469 1.9 matt printf("usb ref clk = %u (%#x)\n", clk->clk_usb_ref, clk->clk_usb_ref);
470 1.1 matt #endif
471 1.1 matt }
472 1.1 matt
473 1.1 matt void
474 1.1 matt bcm53xx_bootstrap(vaddr_t iobase)
475 1.1 matt {
476 1.1 matt struct bcm53xx_chip_state bcs;
477 1.1 matt int error;
478 1.1 matt
479 1.1 matt #ifdef BCM53XX_CONSOLE_EARLY
480 1.1 matt com_base = iobase + CCA_UART0_BASE;
481 1.1 matt cn_tab = &bcm53xx_earlycons;
482 1.1 matt #endif
483 1.1 matt
484 1.1 matt bcm53xx_ioreg_bsh = (bus_space_handle_t) iobase;
485 1.1 matt error = bus_space_map(bcm53xx_ioreg_bst, BCM53XX_IOREG_PBASE,
486 1.1 matt BCM53XX_IOREG_SIZE, 0, &bcm53xx_ioreg_bsh);
487 1.1 matt if (error)
488 1.1 matt panic("%s: failed to map BCM53xx %s registers: %d",
489 1.1 matt __func__, "io", error);
490 1.1 matt
491 1.1 matt bcm53xx_armcore_bsh = (bus_space_handle_t) iobase + BCM53XX_IOREG_SIZE;
492 1.1 matt error = bus_space_map(bcm53xx_armcore_bst, BCM53XX_ARMCORE_PBASE,
493 1.1 matt BCM53XX_ARMCORE_SIZE, 0, &bcm53xx_armcore_bsh);
494 1.1 matt if (error)
495 1.1 matt panic("%s: failed to map BCM53xx %s registers: %d",
496 1.1 matt __func__, "armcore", error);
497 1.1 matt
498 1.1 matt curcpu()->ci_softc = &cpu_softc;
499 1.1 matt
500 1.1 matt bcm53xx_get_chip_ioreg_state(&bcs, bcm53xx_ioreg_bst, bcm53xx_ioreg_bsh);
501 1.1 matt bcm53xx_get_chip_armcore_state(&bcs, bcm53xx_armcore_bst, bcm53xx_armcore_bsh);
502 1.1 matt
503 1.9 matt struct bcm53xx_clock_info * const clk = &cpu_softc.cpu_clk;
504 1.1 matt
505 1.1 matt bcm53xx_clock_init(clk);
506 1.1 matt bcm53xx_lcpll_clock_init(clk, bcs.bcs_lcpll_control1,
507 1.1 matt bcs.bcs_lcpll_control2);
508 1.1 matt bcm53xx_genpll_clock_init(clk, bcs.bcs_genpll_control5,
509 1.1 matt bcs.bcs_genpll_control6, bcs.bcs_genpll_control7);
510 1.1 matt bcm53xx_usb_clock_init(clk, bcs.bcs_usb2_control);
511 1.1 matt bcm53xx_get_ddr_freq(clk, bcs.bcs_ddr_phy_ctl_pll_status,
512 1.1 matt bcs.bcs_ddr_phy_ctl_pll_dividers);
513 1.1 matt bcm53xx_get_cpu_freq(clk, bcs.bcs_armcore_clk_pllarma,
514 1.1 matt bcs.bcs_armcore_clk_pllarmb, bcs.bcs_armcore_clk_policy);
515 1.1 matt
516 1.1 matt curcpu()->ci_data.cpu_cc_freq = clk->clk_cpu;
517 1.2 matt
518 1.2 matt arml2cc_init(bcm53xx_armcore_bst, bcm53xx_armcore_bsh, ARMCORE_L2C_BASE);
519 1.1 matt }
520 1.1 matt
521 1.5 matt void
522 1.5 matt bcm53xx_dma_bootstrap(psize_t memsize)
523 1.5 matt {
524 1.5 matt if (memsize > 256*1024*1024) {
525 1.5 matt /*
526 1.5 matt * By setting up two ranges, bus_dmamem_alloc will always
527 1.5 matt * try to allocate from range 0 first resulting in allocations
528 1.5 matt * below 256MB which for PCI and GMAC are coherent.
529 1.5 matt */
530 1.5 matt bcm53xx_dma_ranges[1].dr_len = memsize - 0x10000000;
531 1.8 matt bcm53xx_coherent_dma_ranges[1].dr_len = memsize - 0x10000000;
532 1.6 matt } else {
533 1.8 matt bcm53xx_dma_ranges[0].dr_len = memsize;
534 1.6 matt bcm53xx_coherent_dma_ranges[0].dr_len = memsize;
535 1.8 matt bcm53xx_dma_tag._nranges = 1;
536 1.6 matt bcm53xx_coherent_dma_tag._nranges = 1;
537 1.5 matt }
538 1.8 matt KASSERT(bcm53xx_dma_tag._ranges[0].dr_flags == 0);
539 1.8 matt KASSERT(bcm53xx_coherent_dma_tag._ranges[0].dr_flags == _BUS_DMAMAP_COHERENT);
540 1.5 matt }
541 1.5 matt
542 1.1 matt #ifdef MULTIPROCESSOR
543 1.1 matt void
544 1.1 matt bcm53xx_cpu_hatch(struct cpu_info *ci)
545 1.1 matt {
546 1.1 matt a9tmr_init_cpu_clock(ci);
547 1.1 matt }
548 1.1 matt #endif
549 1.1 matt
550 1.1 matt void
551 1.1 matt bcm53xx_device_register(device_t self, void *aux)
552 1.1 matt {
553 1.1 matt prop_dictionary_t dict = device_properties(self);
554 1.1 matt
555 1.1 matt if (device_is_a(self, "armperiph")
556 1.1 matt && device_is_a(device_parent(self), "mainbus")) {
557 1.1 matt /*
558 1.1 matt * XXX KLUDGE ALERT XXX
559 1.1 matt * The iot mainbus supplies is completely wrong since it scales
560 1.1 matt * addresses by 2. The simpliest remedy is to replace with our
561 1.1 matt * bus space used for the armcore regisers (which armperiph uses).
562 1.1 matt */
563 1.1 matt struct mainbus_attach_args * const mb = aux;
564 1.1 matt mb->mb_iot = bcm53xx_armcore_bst;
565 1.1 matt return;
566 1.1 matt }
567 1.1 matt
568 1.1 matt /*
569 1.1 matt * We need to tell the A9 Global/Watchdog Timer
570 1.1 matt * what frequency it runs at.
571 1.1 matt */
572 1.1 matt if (device_is_a(self, "a9tmr") || device_is_a(self, "a9wdt")) {
573 1.1 matt /*
574 1.1 matt * This clock always runs at (arm_clk div 2) and only goes
575 1.1 matt * to timers that are part of the A9 MP core subsystem.
576 1.1 matt */
577 1.1 matt prop_dictionary_set_uint32(dict, "frequency",
578 1.9 matt cpu_softc.cpu_clk.clk_cpu / 2);
579 1.1 matt return;
580 1.4 matt }
581 1.4 matt
582 1.4 matt if (device_is_a(self, "bcmeth")) {
583 1.4 matt const struct bcmccb_attach_args * const ccbaa = aux;
584 1.4 matt const uint8_t enaddr[ETHER_ADDR_LEN] = {
585 1.4 matt 0x00, 0x01, 0x02, 0x03, 0x04,
586 1.4 matt 0x05 + 2 * ccbaa->ccbaa_loc.loc_port,
587 1.4 matt };
588 1.4 matt prop_data_t pd = prop_data_create_data(enaddr, ETHER_ADDR_LEN);
589 1.4 matt KASSERT(pd != NULL);
590 1.4 matt if (prop_dictionary_set(device_properties(self), "mac-address", pd) == false) {
591 1.4 matt printf("WARNING: Unable to set mac-address property for %s\n", device_xname(self));
592 1.4 matt }
593 1.4 matt prop_object_release(pd);
594 1.4 matt }
595 1.4 matt }
596 1.4 matt
597 1.4 matt static kmutex_t srab_lock __cacheline_aligned;
598 1.4 matt
599 1.4 matt void
600 1.4 matt bcm53xx_srab_init(void)
601 1.4 matt {
602 1.4 matt mutex_init(&srab_lock, MUTEX_DEFAULT, IPL_VM);
603 1.4 matt
604 1.4 matt bcm53xx_srab_write_4(0x0079, 0x90); // reset switch
605 1.4 matt for (u_int port = 0; port < 8; port++) {
606 1.4 matt /* per port control: no stp */
607 1.4 matt bcm53xx_srab_write_4(port, 0x00);
608 1.4 matt }
609 1.4 matt bcm53xx_srab_write_4(0x0008, 0x1c); // IMP port (enab UC/MC/BC)
610 1.4 matt bcm53xx_srab_write_4(0x000e, 0xbb); // IMP port force-link 1G
611 1.4 matt bcm53xx_srab_write_4(0x005d, 0x7b); // port5 force-link 1G
612 1.4 matt bcm53xx_srab_write_4(0x005f, 0x7b); // port7 force-link 1G
613 1.4 matt bcm53xx_srab_write_4(0x000b, 0x7); // management mode
614 1.4 matt bcm53xx_srab_write_4(0x0203, 0x0); // disable BRCM tag
615 1.4 matt bcm53xx_srab_write_4(0x0200, 0x80); // enable IMP=port8
616 1.4 matt }
617 1.4 matt
618 1.4 matt static inline void
619 1.4 matt bcm53xx_srab_busywait(bus_space_tag_t bst, bus_space_handle_t bsh)
620 1.4 matt {
621 1.4 matt while (bus_space_read_4(bst, bsh, SRAB_BASE + SRAB_CMDSTAT) & SRA_GORDYN) {
622 1.4 matt delay(10);
623 1.4 matt }
624 1.4 matt }
625 1.4 matt
626 1.4 matt uint32_t
627 1.4 matt bcm53xx_srab_read_4(u_int pageoffset)
628 1.4 matt {
629 1.4 matt bus_space_tag_t bst = bcm53xx_ioreg_bst;
630 1.4 matt bus_space_handle_t bsh = bcm53xx_ioreg_bsh;
631 1.4 matt uint32_t rv;
632 1.4 matt
633 1.4 matt mutex_spin_enter(&srab_lock);
634 1.4 matt
635 1.4 matt bcm53xx_srab_busywait(bst, bsh);
636 1.4 matt bus_space_write_4(bst, bsh, SRAB_BASE + SRAB_CMDSTAT,
637 1.4 matt __SHIFTIN(pageoffset, SRA_PAGEOFFSET) | SRA_GORDYN);
638 1.4 matt bcm53xx_srab_busywait(bst, bsh);
639 1.4 matt rv = bus_space_read_4(bst, bsh, SRAB_BASE + SRAB_RDL);
640 1.4 matt
641 1.4 matt mutex_spin_exit(&srab_lock);
642 1.4 matt return rv;
643 1.4 matt }
644 1.4 matt
645 1.4 matt uint64_t
646 1.4 matt bcm53xx_srab_read_8(u_int pageoffset)
647 1.4 matt {
648 1.4 matt bus_space_tag_t bst = bcm53xx_ioreg_bst;
649 1.4 matt bus_space_handle_t bsh = bcm53xx_ioreg_bsh;
650 1.4 matt uint64_t rv;
651 1.4 matt
652 1.4 matt mutex_spin_enter(&srab_lock);
653 1.4 matt
654 1.4 matt bcm53xx_srab_busywait(bst, bsh);
655 1.4 matt bus_space_write_4(bst, bsh, SRAB_BASE + SRAB_CMDSTAT,
656 1.4 matt __SHIFTIN(pageoffset, SRA_PAGEOFFSET) | SRA_GORDYN);
657 1.4 matt bcm53xx_srab_busywait(bst, bsh);
658 1.4 matt rv = bus_space_read_4(bst, bsh, SRAB_BASE + SRAB_RDH);
659 1.4 matt rv <<= 32;
660 1.4 matt rv |= bus_space_read_4(bst, bsh, SRAB_BASE + SRAB_RDL);
661 1.4 matt
662 1.4 matt mutex_spin_exit(&srab_lock);
663 1.4 matt return rv;
664 1.4 matt }
665 1.4 matt
666 1.4 matt void
667 1.4 matt bcm53xx_srab_write_4(u_int pageoffset, uint32_t val)
668 1.4 matt {
669 1.4 matt bus_space_tag_t bst = bcm53xx_ioreg_bst;
670 1.4 matt bus_space_handle_t bsh = bcm53xx_ioreg_bsh;
671 1.4 matt
672 1.4 matt mutex_spin_enter(&srab_lock);
673 1.4 matt
674 1.4 matt bcm53xx_srab_busywait(bst, bsh);
675 1.4 matt bus_space_write_4(bst, bsh, SRAB_BASE + SRAB_WDL, val);
676 1.4 matt bus_space_write_4(bst, bsh, SRAB_BASE + SRAB_CMDSTAT,
677 1.4 matt __SHIFTIN(pageoffset, SRA_PAGEOFFSET) | SRA_WRITE | SRA_GORDYN);
678 1.4 matt bcm53xx_srab_busywait(bst, bsh);
679 1.4 matt
680 1.4 matt mutex_spin_exit(&srab_lock);
681 1.4 matt }
682 1.4 matt
683 1.4 matt void
684 1.4 matt bcm53xx_srab_write_8(u_int pageoffset, uint64_t val)
685 1.4 matt {
686 1.4 matt bus_space_tag_t bst = bcm53xx_ioreg_bst;
687 1.4 matt bus_space_handle_t bsh = bcm53xx_ioreg_bsh;
688 1.4 matt
689 1.4 matt mutex_spin_enter(&srab_lock);
690 1.4 matt
691 1.4 matt bcm53xx_srab_busywait(bst, bsh);
692 1.4 matt bus_space_write_4(bst, bsh, SRAB_BASE + SRAB_WDL, val);
693 1.4 matt bus_space_write_4(bst, bsh, SRAB_BASE + SRAB_WDH, val >> 32);
694 1.4 matt bus_space_write_4(bst, bsh, SRAB_BASE + SRAB_CMDSTAT,
695 1.4 matt __SHIFTIN(pageoffset, SRA_PAGEOFFSET) | SRA_WRITE | SRA_GORDYN);
696 1.4 matt bcm53xx_srab_busywait(bst, bsh);
697 1.4 matt mutex_spin_exit(&srab_lock);
698 1.1 matt }
699