s5_machdep.c revision 216318
1/*- 2 * Copyright (c) 2007 Bruce M. Simpson. 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 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. 13 * 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 24 * SUCH DAMAGE. 25 */ 26 27#include <sys/cdefs.h> 28__FBSDID("$FreeBSD: head/sys/mips/sentry5/s5_machdep.c 216318 2010-12-09 07:01:03Z gonzo $"); 29 30#include <sys/param.h> 31#include <machine/cpuregs.h> 32 33#include <mips/sentry5/s5reg.h> 34 35#include "opt_ddb.h" 36 37#include <sys/param.h> 38#include <sys/conf.h> 39#include <sys/kernel.h> 40#include <sys/systm.h> 41#include <sys/imgact.h> 42#include <sys/bio.h> 43#include <sys/buf.h> 44#include <sys/bus.h> 45#include <sys/cpu.h> 46#include <sys/cons.h> 47#include <sys/exec.h> 48#include <sys/ucontext.h> 49#include <sys/proc.h> 50#include <sys/kdb.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> 56#include <sys/user.h> 57 58#include <vm/vm.h> 59#include <vm/vm_object.h> 60#include <vm/vm_page.h> 61#include <vm/vm_pager.h> 62 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> 77 78#ifdef CFE 79#include <dev/cfe/cfe_api.h> 80#endif 81 82extern int *edata; 83extern int *end; 84 85void 86platform_cpu_init() 87{ 88 /* Nothing special */ 89} 90 91static void 92mips_init(void) 93{ 94 int i, j; 95 96 printf("entry: mips_init()\n"); 97 98#ifdef CFE 99 /* 100 * Query DRAM memory map from CFE. 101 */ 102 physmem = 0; 103 for (i = 0; i < 10; i += 2) { 104 int result; 105 uint64_t addr, len, type; 106 107 result = cfe_enummem(i, 0, &addr, &len, &type); 108 if (result < 0) { 109 phys_avail[i] = phys_avail[i + 1] = 0; 110 break; 111 } 112 if (type != CFE_MI_AVAILABLE) 113 continue; 114 115 phys_avail[i] = addr; 116 if (i == 0 && addr == 0) { 117 /* 118 * If this is the first physical memory segment probed 119 * from CFE, omit the region at the start of physical 120 * memory where the kernel has been loaded. 121 */ 122 phys_avail[i] += MIPS_KSEG0_TO_PHYS(kernel_kseg0_end); 123 } 124 phys_avail[i + 1] = addr + len; 125 physmem += len; 126 } 127 128 realmem = btoc(physmem); 129#endif 130 131 for (j = 0; j < i; j += 2) { 132 dump_avail[j] = phys_avail[j]; 133 dump_avail[j+1] = phys_avail[j+1] - phys_avail[j]; 134 } 135 136 physmem = realmem; 137 138 init_param1(); 139 init_param2(physmem); 140 mips_cpu_init(); 141 pmap_bootstrap(); 142 mips_proc0_init(); 143 mutex_init(); 144 kdb_init(); 145#ifdef KDB 146 if (boothowto & RB_KDB) 147 kdb_enter(KDB_WHY_BOOTFLAGS, "Boot flags requested debugger"); 148#endif 149} 150 151void 152platform_halt(void) 153{ 154 155} 156 157 158void 159platform_identify(void) 160{ 161 162} 163 164void 165platform_reset(void) 166{ 167 168#if defined(CFE) 169 cfe_exit(0, 0); 170#else 171 *((volatile uint8_t *)MIPS_PHYS_TO_KSEG1(SENTRY5_EXTIFADR)) = 0x80; 172#endif 173} 174 175void 176platform_trap_enter(void) 177{ 178 179} 180 181void 182platform_trap_exit(void) 183{ 184 185} 186 187void 188platform_start(__register_t a0, __register_t a1, __register_t a2, 189 __register_t a3) 190{ 191 vm_offset_t kernend; 192 uint64_t platform_counter_freq; 193 194 /* clear the BSS and SBSS segments */ 195 kernend = (vm_offset_t)&end; 196 memset(&edata, 0, kernend - (vm_offset_t)(&edata)); 197 198 mips_postboot_fixup(); 199 200 /* Initialize pcpu stuff */ 201 mips_pcpu0_init(); 202 203#ifdef CFE 204 /* 205 * Initialize CFE firmware trampolines before 206 * we initialize the low-level console. 207 * 208 * CFE passes the following values in registers: 209 * a0: firmware handle 210 * a2: firmware entry point 211 * a3: entry point seal 212 */ 213 if (a3 == CFE_EPTSEAL) 214 cfe_init(a0, a2); 215#endif 216 cninit(); 217 218 mips_init(); 219 220# if 0 221 /* 222 * Probe the Broadcom Sentry5's on-chip PLL clock registers 223 * and discover the CPU pipeline clock and bus clock 224 * multipliers from this. 225 * XXX: Wrong place. You have to ask the ChipCommon 226 * or External Interface cores on the SiBa. 227 */ 228 uint32_t busmult, cpumult, refclock, clkcfg1; 229#define S5_CLKCFG1_REFCLOCK_MASK 0x0000001F 230#define S5_CLKCFG1_BUSMULT_MASK 0x000003E0 231#define S5_CLKCFG1_BUSMULT_SHIFT 5 232#define S5_CLKCFG1_CPUMULT_MASK 0xFFFFFC00 233#define S5_CLKCFG1_CPUMULT_SHIFT 10 234 235 counter_freq = 100000000; /* XXX */ 236 237 clkcfg1 = s5_rd_clkcfg1(); 238 printf("clkcfg1 = 0x%08x\n", clkcfg1); 239 240 refclock = clkcfg1 & 0x1F; 241 busmult = ((clkcfg1 & 0x000003E0) >> 5) + 1; 242 cpumult = ((clkcfg1 & 0xFFFFFC00) >> 10) + 1; 243 244 printf("refclock = %u\n", refclock); 245 printf("busmult = %u\n", busmult); 246 printf("cpumult = %u\n", cpumult); 247 248 counter_freq = cpumult * refclock; 249# else 250 platform_counter_freq = 200 * 1000 * 1000; /* Sentry5 is 200MHz */ 251# endif 252 253 mips_timer_init_params(platform_counter_freq, 0); 254} 255