root / hw / ppce500_spin.c @ 0200db65
History | View | Annotate | Download (5.3 kB)
1 |
/*
|
---|---|
2 |
* QEMU PowerPC e500v2 ePAPR spinning code
|
3 |
*
|
4 |
* Copyright (C) 2011 Freescale Semiconductor, Inc. All rights reserved.
|
5 |
*
|
6 |
* Author: Alexander Graf, <agraf@suse.de>
|
7 |
*
|
8 |
* This library is free software; you can redistribute it and/or
|
9 |
* modify it under the terms of the GNU Lesser General Public
|
10 |
* License as published by the Free Software Foundation; either
|
11 |
* version 2 of the License, or (at your option) any later version.
|
12 |
*
|
13 |
* This library is distributed in the hope that it will be useful,
|
14 |
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
15 |
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
16 |
* Lesser General Public License for more details.
|
17 |
*
|
18 |
* You should have received a copy of the GNU Lesser General Public
|
19 |
* License along with this library; if not, see <http://www.gnu.org/licenses/>.
|
20 |
*
|
21 |
* This code is not really a device, but models an interface that usually
|
22 |
* firmware takes care of. It's used when QEMU plays the role of firmware.
|
23 |
*
|
24 |
* Specification:
|
25 |
*
|
26 |
* https://www.power.org/resources/downloads/Power_ePAPR_APPROVED_v1.1.pdf
|
27 |
*
|
28 |
*/
|
29 |
|
30 |
#include "hw.h" |
31 |
#include "sysemu.h" |
32 |
#include "sysbus.h" |
33 |
#include "kvm.h" |
34 |
|
35 |
#define MAX_CPUS 32 |
36 |
|
37 |
typedef struct spin_info { |
38 |
uint64_t addr; |
39 |
uint64_t r3; |
40 |
uint32_t resv; |
41 |
uint32_t pir; |
42 |
uint64_t reserved; |
43 |
} __attribute__ ((packed)) SpinInfo; |
44 |
|
45 |
typedef struct spin_state { |
46 |
SysBusDevice busdev; |
47 |
MemoryRegion iomem; |
48 |
SpinInfo spin[MAX_CPUS]; |
49 |
} SpinState; |
50 |
|
51 |
typedef struct spin_kick { |
52 |
CPUState *env; |
53 |
SpinInfo *spin; |
54 |
} SpinKick; |
55 |
|
56 |
static void spin_reset(void *opaque) |
57 |
{ |
58 |
SpinState *s = opaque; |
59 |
int i;
|
60 |
|
61 |
for (i = 0; i < MAX_CPUS; i++) { |
62 |
SpinInfo *info = &s->spin[i]; |
63 |
|
64 |
info->pir = i; |
65 |
info->r3 = i; |
66 |
info->addr = 1;
|
67 |
} |
68 |
} |
69 |
|
70 |
/* Create -kernel TLB entries for BookE, linearly spanning 256MB. */
|
71 |
static inline target_phys_addr_t booke206_page_size_to_tlb(uint64_t size) |
72 |
{ |
73 |
return (ffs(size >> 10) - 1) >> 1; |
74 |
} |
75 |
|
76 |
static void mmubooke_create_initial_mapping(CPUState *env, |
77 |
target_ulong va, |
78 |
target_phys_addr_t pa, |
79 |
target_phys_addr_t len) |
80 |
{ |
81 |
ppcmas_tlb_t *tlb = booke206_get_tlbm(env, 1, 0, 1); |
82 |
target_phys_addr_t size; |
83 |
|
84 |
size = (booke206_page_size_to_tlb(len) << MAS1_TSIZE_SHIFT); |
85 |
tlb->mas1 = MAS1_VALID | size; |
86 |
tlb->mas2 = (va & TARGET_PAGE_MASK) | MAS2_M; |
87 |
tlb->mas7_3 = pa & TARGET_PAGE_MASK; |
88 |
tlb->mas7_3 |= MAS3_UR | MAS3_UW | MAS3_UX | MAS3_SR | MAS3_SW | MAS3_SX; |
89 |
} |
90 |
|
91 |
static void spin_kick(void *data) |
92 |
{ |
93 |
SpinKick *kick = data; |
94 |
CPUState *env = kick->env; |
95 |
SpinInfo *curspin = kick->spin; |
96 |
target_phys_addr_t map_size = 64 * 1024 * 1024; |
97 |
target_phys_addr_t map_start; |
98 |
|
99 |
cpu_synchronize_state(env); |
100 |
stl_p(&curspin->pir, env->spr[SPR_PIR]); |
101 |
env->nip = ldq_p(&curspin->addr) & (map_size - 1);
|
102 |
env->gpr[3] = ldq_p(&curspin->r3);
|
103 |
env->gpr[4] = 0; |
104 |
env->gpr[5] = 0; |
105 |
env->gpr[6] = 0; |
106 |
env->gpr[7] = map_size;
|
107 |
env->gpr[8] = 0; |
108 |
env->gpr[9] = 0; |
109 |
|
110 |
map_start = ldq_p(&curspin->addr) & ~(map_size - 1);
|
111 |
mmubooke_create_initial_mapping(env, 0, map_start, map_size);
|
112 |
|
113 |
env->halted = 0;
|
114 |
env->exception_index = -1;
|
115 |
qemu_cpu_kick(env); |
116 |
} |
117 |
|
118 |
static void spin_write(void *opaque, target_phys_addr_t addr, uint64_t value, |
119 |
unsigned len)
|
120 |
{ |
121 |
SpinState *s = opaque; |
122 |
int env_idx = addr / sizeof(SpinInfo); |
123 |
CPUState *env; |
124 |
SpinInfo *curspin = &s->spin[env_idx]; |
125 |
uint8_t *curspin_p = (uint8_t*)curspin; |
126 |
|
127 |
for (env = first_cpu; env != NULL; env = env->next_cpu) { |
128 |
if (env->cpu_index == env_idx) {
|
129 |
break;
|
130 |
} |
131 |
} |
132 |
|
133 |
if (!env) {
|
134 |
/* Unknown CPU */
|
135 |
return;
|
136 |
} |
137 |
|
138 |
if (!env->cpu_index) {
|
139 |
/* primary CPU doesn't spin */
|
140 |
return;
|
141 |
} |
142 |
|
143 |
curspin_p = &curspin_p[addr % sizeof(SpinInfo)];
|
144 |
switch (len) {
|
145 |
case 1: |
146 |
stb_p(curspin_p, value); |
147 |
break;
|
148 |
case 2: |
149 |
stw_p(curspin_p, value); |
150 |
break;
|
151 |
case 4: |
152 |
stl_p(curspin_p, value); |
153 |
break;
|
154 |
} |
155 |
|
156 |
if (!(ldq_p(&curspin->addr) & 1)) { |
157 |
/* run CPU */
|
158 |
SpinKick kick = { |
159 |
.env = env, |
160 |
.spin = curspin, |
161 |
}; |
162 |
|
163 |
run_on_cpu(env, spin_kick, &kick); |
164 |
} |
165 |
} |
166 |
|
167 |
static uint64_t spin_read(void *opaque, target_phys_addr_t addr, unsigned len) |
168 |
{ |
169 |
SpinState *s = opaque; |
170 |
uint8_t *spin_p = &((uint8_t*)s->spin)[addr]; |
171 |
|
172 |
switch (len) {
|
173 |
case 1: |
174 |
return ldub_p(spin_p);
|
175 |
case 2: |
176 |
return lduw_p(spin_p);
|
177 |
case 4: |
178 |
return ldl_p(spin_p);
|
179 |
default:
|
180 |
assert(0);
|
181 |
} |
182 |
} |
183 |
|
184 |
const MemoryRegionOps spin_rw_ops = {
|
185 |
.read = spin_read, |
186 |
.write = spin_write, |
187 |
.endianness = DEVICE_BIG_ENDIAN, |
188 |
}; |
189 |
|
190 |
static int ppce500_spin_initfn(SysBusDevice *dev) |
191 |
{ |
192 |
SpinState *s; |
193 |
|
194 |
s = FROM_SYSBUS(SpinState, sysbus_from_qdev(dev)); |
195 |
|
196 |
memory_region_init_io(&s->iomem, &spin_rw_ops, s, "e500 spin pv device",
|
197 |
sizeof(SpinInfo) * MAX_CPUS);
|
198 |
sysbus_init_mmio_region(dev, &s->iomem); |
199 |
|
200 |
qemu_register_reset(spin_reset, s); |
201 |
|
202 |
return 0; |
203 |
} |
204 |
|
205 |
static SysBusDeviceInfo ppce500_spin_info = {
|
206 |
.init = ppce500_spin_initfn, |
207 |
.qdev.name = "e500-spin",
|
208 |
.qdev.size = sizeof(SpinState),
|
209 |
}; |
210 |
|
211 |
static void ppce500_spin_register(void) |
212 |
{ |
213 |
sysbus_register_withprop(&ppce500_spin_info); |
214 |
} |
215 |
device_init(ppce500_spin_register); |