1 /* $NetBSD: cpu.c,v 1.7 2011/06/12 07:07:17 kiyohara Exp $ */ 2 3 /* 4 * This file contains information proprietary to Be Inc. 5 */ 6 7 /*- 8 * Copyright (C) 1995-1997 Gary Thomas (gdt@linuxppc.org) 9 * All rights reserved. 10 * 11 * Redistribution and use in source and binary forms, with or without 12 * modification, are permitted provided that the following conditions 13 * are met: 14 * 1. Redistributions of source code must retain the above copyright 15 * notice, this list of conditions and the following disclaimer. 16 * 2. Redistributions in binary form must reproduce the above copyright 17 * notice, this list of conditions and the following disclaimer in the 18 * documentation and/or other materials provided with the distribution. 19 * 3. All advertising materials mentioning features or use of this software 20 * must display the following acknowledgement: 21 * This product includes software developed by Gary Thomas. 22 * 4. The name of the author may not be used to endorse or promote products 23 * derived from this software without specific prior written permission. 24 * 25 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 26 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 27 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 28 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 29 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 30 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 31 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 32 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 33 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 34 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 35 */ 36 37 #include <lib/libsa/stand.h> 38 #include "boot.h" 39 40 /* 41 * Return the ordinal of the CPU on which the code runs (0/1) 42 */ 43 44 #define CPU1_HRESET 0x20000000 45 46 int 47 whichCPU(void) 48 { 49 volatile unsigned long *CPU_control = (unsigned long *)0x7FFFF3F0; 50 51 if (*CPU_control & 0x02000000) { 52 return 1; 53 } else { 54 return 0; 55 } 56 } 57 58 /* 59 * Force CPU #1 into Hard RESET state 60 */ 61 void 62 resetCPU1(void) 63 { 64 volatile unsigned long *CPU_control = (unsigned long *)0x7FFFF4F0; 65 66 *CPU_control = CPU1_HRESET; 67 } 68 69 /* 70 * Return state of CPU RESET register 71 */ 72 unsigned long 73 cpuState(void) 74 { 75 volatile unsigned long *CPU_control = (unsigned long *)0x7FFFF4F0; 76 77 return *CPU_control; 78 } 79 80 /* 81 * Start CPU #1 82 */ 83 void 84 runCPU1(void *entry) 85 { 86 volatile unsigned long *CPU_control = (unsigned long *)0x7FFFF4F0; 87 long *PEF_vector = (long *)0x3000; 88 long *PEF_vector2 = (long *)0x3018; 89 90 PEF_vector[0] = 0; 91 PEF_vector[1] = 0; 92 PEF_vector[2] = 0; 93 PEF_vector[3] = 0; 94 PEF_vector[0] = 0; 95 PEF_vector2[0] = 0; 96 *CPU_control = 0x80000000 | CPU1_HRESET; 97 /* Give the other CPU a chance to find the zero value */ 98 delay(1000); 99 PEF_vector[0] = (long)entry; 100 PEF_vector[1] = (long)entry; 101 PEF_vector[2] = (long)entry; 102 PEF_vector[3] = (long)entry; 103 PEF_vector[0] = (long)entry; 104 PEF_vector2[0] = (long)entry; 105 } 106 107 /* 108 * CPU #1 runs here 109 */ 110 volatile int cpu_ctr = 0; 111 112 void 113 cpu1(void) 114 { 115 while (1) 116 cpu_ctr++; 117 } 118 119 volatile int CPU1_alive = 0; 120 121 void 122 start_CPU1(void) 123 { 124 volatile long *key = (volatile long *)0x0080; 125 126 CPU1_alive++; 127 *key = 0; 128 /* Wait for a kernel to load up a vector of where we should jump */ 129 while (*key == 0) 130 delay(10); 131 132 run(NULL, NULL, NULL, NULL, (void *)*key); 133 } 134 135 void 136 wait_for(volatile int *ptr) 137 { 138 int i; 139 for (i = 0; i < 10; i++) { 140 if (*ptr) 141 return; 142 delay(10); 143 } 144 printf("CPU #1 didn't start!\n"); 145 } 146