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
whichCPU(void)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
resetCPU1(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
cpuState(void)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
runCPU1(void * entry)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
cpu1(void)113 cpu1(void)
114 {
115 while (1)
116 cpu_ctr++;
117 }
118
119 volatile int CPU1_alive = 0;
120
121 void
start_CPU1(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
wait_for(volatile int * ptr)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