2 * Copyright (c) 2007 Bruce M. Simpson.
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD$");
30 #include <sys/param.h>
31 #include <machine/cpuregs.h>
33 #include <mips/sentry5/s5reg.h>
37 #include <sys/param.h>
39 #include <sys/kernel.h>
40 #include <sys/systm.h>
41 #include <sys/imgact.h>
48 #include <sys/ucontext.h>
51 #include <sys/ptrace.h>
52 #include <sys/reboot.h>
53 #include <sys/signalvar.h>
54 #include <sys/sysent.h>
55 #include <sys/sysproto.h>
59 #include <vm/vm_object.h>
60 #include <vm/vm_page.h>
61 #include <vm/vm_pager.h>
63 #include <machine/cache.h>
64 #include <machine/clock.h>
65 #include <machine/cpu.h>
66 #include <machine/cpuinfo.h>
67 #include <machine/cpufunc.h>
68 #include <machine/cpuregs.h>
69 #include <machine/hwfunc.h>
70 #include <machine/intr_machdep.h>
71 #include <machine/locore.h>
72 #include <machine/md_var.h>
73 #include <machine/pte.h>
74 #include <machine/sigframe.h>
75 #include <machine/trap.h>
76 #include <machine/vmparam.h>
79 #include <dev/cfe/cfe_api.h>
83 extern uint32_t cfe_handle;
84 extern uint32_t cfe_vector;
95 printf("entry: mips_init()\n");
99 * Query DRAM memory map from CFE.
102 for (i = 0; i < 10; i += 2) {
104 uint64_t addr, len, type;
106 result = cfe_enummem(i, 0, &addr, &len, &type);
108 phys_avail[i] = phys_avail[i + 1] = 0;
111 if (type != CFE_MI_AVAILABLE)
114 phys_avail[i] = addr;
115 if (i == 0 && addr == 0) {
117 * If this is the first physical memory segment probed
118 * from CFE, omit the region at the start of physical
119 * memory where the kernel has been loaded.
121 phys_avail[i] += MIPS_KSEG0_TO_PHYS((vm_offset_t)&end);
123 phys_avail[i + 1] = addr + len;
127 realmem = btoc(physmem);
133 init_param2(physmem);
151 platform_identify(void)
163 *((volatile uint8_t *)MIPS_PHYS_TO_KSEG1(SENTRY5_EXTIFADR)) = 0x80;
168 platform_trap_enter(void)
174 platform_trap_exit(void)
180 platform_start(__register_t a0 __unused, __register_t a1 __unused,
181 __register_t a2 __unused, __register_t a3 __unused)
184 uint64_t platform_counter_freq;
186 /* clear the BSS and SBSS segments */
187 kernend = round_page((vm_offset_t)&end);
188 memset(&edata, 0, kernend - (vm_offset_t)(&edata));
192 * Initialize CFE firmware trampolines before
193 * we initialize the low-level console.
196 cfe_init(cfe_handle, cfe_vector);
202 panic("CFE was not detected by locore.\n");
208 * Probe the Broadcom Sentry5's on-chip PLL clock registers
209 * and discover the CPU pipeline clock and bus clock
210 * multipliers from this.
211 * XXX: Wrong place. You have to ask the ChipCommon
212 * or External Interface cores on the SiBa.
214 uint32_t busmult, cpumult, refclock, clkcfg1;
215 #define S5_CLKCFG1_REFCLOCK_MASK 0x0000001F
216 #define S5_CLKCFG1_BUSMULT_MASK 0x000003E0
217 #define S5_CLKCFG1_BUSMULT_SHIFT 5
218 #define S5_CLKCFG1_CPUMULT_MASK 0xFFFFFC00
219 #define S5_CLKCFG1_CPUMULT_SHIFT 10
221 counter_freq = 100000000; /* XXX */
223 clkcfg1 = s5_rd_clkcfg1();
224 printf("clkcfg1 = 0x%08x\n", clkcfg1);
226 refclock = clkcfg1 & 0x1F;
227 busmult = ((clkcfg1 & 0x000003E0) >> 5) + 1;
228 cpumult = ((clkcfg1 & 0xFFFFFC00) >> 10) + 1;
230 printf("refclock = %u\n", refclock);
231 printf("busmult = %u\n", busmult);
232 printf("cpumult = %u\n", cpumult);
234 counter_freq = cpumult * refclock;
236 platform_counter_freq = 200 * 1000 * 1000; /* Sentry5 is 200MHz */
239 mips_timer_init_params(platform_counter_freq, 0);