root / hw / omap1.c @ cde844fa
History | View | Annotate | Download (115.7 kB)
1 | c3d2689d | balrog | /*
|
---|---|---|---|
2 | c3d2689d | balrog | * TI OMAP processors emulation.
|
3 | c3d2689d | balrog | *
|
4 | b4e3104b | balrog | * Copyright (C) 2006-2008 Andrzej Zaborowski <balrog@zabor.org>
|
5 | c3d2689d | balrog | *
|
6 | c3d2689d | balrog | * This program is free software; you can redistribute it and/or
|
7 | c3d2689d | balrog | * modify it under the terms of the GNU General Public License as
|
8 | 827df9f3 | balrog | * published by the Free Software Foundation; either version 2 or
|
9 | 827df9f3 | balrog | * (at your option) version 3 of the License.
|
10 | c3d2689d | balrog | *
|
11 | c3d2689d | balrog | * This program is distributed in the hope that it will be useful,
|
12 | c3d2689d | balrog | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
13 | c3d2689d | balrog | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
14 | c3d2689d | balrog | * GNU General Public License for more details.
|
15 | c3d2689d | balrog | *
|
16 | fad6cb1a | aurel32 | * You should have received a copy of the GNU General Public License along
|
17 | 8167ee88 | Blue Swirl | * with this program; if not, see <http://www.gnu.org/licenses/>.
|
18 | c3d2689d | balrog | */
|
19 | 87ecb68b | pbrook | #include "hw.h" |
20 | 87ecb68b | pbrook | #include "arm-misc.h" |
21 | 87ecb68b | pbrook | #include "omap.h" |
22 | 87ecb68b | pbrook | #include "sysemu.h" |
23 | 87ecb68b | pbrook | #include "qemu-timer.h" |
24 | 827df9f3 | balrog | #include "qemu-char.h" |
25 | afbb5194 | balrog | #include "soc_dma.h" |
26 | 87ecb68b | pbrook | /* We use pc-style serial ports. */
|
27 | 87ecb68b | pbrook | #include "pc.h" |
28 | 2446333c | Blue Swirl | #include "blockdev.h" |
29 | 45416789 | Blue Swirl | #include "range.h" |
30 | 77831c20 | Juha Riihimäki | #include "sysbus.h" |
31 | c3d2689d | balrog | |
32 | 827df9f3 | balrog | /* Should signal the TCMI/GPMC */
|
33 | c227f099 | Anthony Liguori | uint32_t omap_badwidth_read8(void *opaque, target_phys_addr_t addr)
|
34 | 66450b15 | balrog | { |
35 | 02645926 | balrog | uint8_t ret; |
36 | 02645926 | balrog | |
37 | 66450b15 | balrog | OMAP_8B_REG(addr); |
38 | b854bc19 | balrog | cpu_physical_memory_read(addr, (void *) &ret, 1); |
39 | 02645926 | balrog | return ret;
|
40 | 66450b15 | balrog | } |
41 | 66450b15 | balrog | |
42 | c227f099 | Anthony Liguori | void omap_badwidth_write8(void *opaque, target_phys_addr_t addr, |
43 | 66450b15 | balrog | uint32_t value) |
44 | 66450b15 | balrog | { |
45 | b854bc19 | balrog | uint8_t val8 = value; |
46 | b854bc19 | balrog | |
47 | 66450b15 | balrog | OMAP_8B_REG(addr); |
48 | b854bc19 | balrog | cpu_physical_memory_write(addr, (void *) &val8, 1); |
49 | 66450b15 | balrog | } |
50 | 66450b15 | balrog | |
51 | c227f099 | Anthony Liguori | uint32_t omap_badwidth_read16(void *opaque, target_phys_addr_t addr)
|
52 | c3d2689d | balrog | { |
53 | b854bc19 | balrog | uint16_t ret; |
54 | b854bc19 | balrog | |
55 | c3d2689d | balrog | OMAP_16B_REG(addr); |
56 | b854bc19 | balrog | cpu_physical_memory_read(addr, (void *) &ret, 2); |
57 | b854bc19 | balrog | return ret;
|
58 | c3d2689d | balrog | } |
59 | c3d2689d | balrog | |
60 | c227f099 | Anthony Liguori | void omap_badwidth_write16(void *opaque, target_phys_addr_t addr, |
61 | c3d2689d | balrog | uint32_t value) |
62 | c3d2689d | balrog | { |
63 | b854bc19 | balrog | uint16_t val16 = value; |
64 | b854bc19 | balrog | |
65 | c3d2689d | balrog | OMAP_16B_REG(addr); |
66 | b854bc19 | balrog | cpu_physical_memory_write(addr, (void *) &val16, 2); |
67 | c3d2689d | balrog | } |
68 | c3d2689d | balrog | |
69 | c227f099 | Anthony Liguori | uint32_t omap_badwidth_read32(void *opaque, target_phys_addr_t addr)
|
70 | c3d2689d | balrog | { |
71 | b854bc19 | balrog | uint32_t ret; |
72 | b854bc19 | balrog | |
73 | c3d2689d | balrog | OMAP_32B_REG(addr); |
74 | b854bc19 | balrog | cpu_physical_memory_read(addr, (void *) &ret, 4); |
75 | b854bc19 | balrog | return ret;
|
76 | c3d2689d | balrog | } |
77 | c3d2689d | balrog | |
78 | c227f099 | Anthony Liguori | void omap_badwidth_write32(void *opaque, target_phys_addr_t addr, |
79 | c3d2689d | balrog | uint32_t value) |
80 | c3d2689d | balrog | { |
81 | c3d2689d | balrog | OMAP_32B_REG(addr); |
82 | b854bc19 | balrog | cpu_physical_memory_write(addr, (void *) &value, 4); |
83 | c3d2689d | balrog | } |
84 | c3d2689d | balrog | |
85 | c3d2689d | balrog | /* MPU OS timers */
|
86 | c3d2689d | balrog | struct omap_mpu_timer_s {
|
87 | 4b3fedf3 | Avi Kivity | MemoryRegion iomem; |
88 | c3d2689d | balrog | qemu_irq irq; |
89 | c3d2689d | balrog | omap_clk clk; |
90 | c3d2689d | balrog | uint32_t val; |
91 | c3d2689d | balrog | int64_t time; |
92 | c3d2689d | balrog | QEMUTimer *timer; |
93 | e856f2ad | balrog | QEMUBH *tick; |
94 | c3d2689d | balrog | int64_t rate; |
95 | c3d2689d | balrog | int it_ena;
|
96 | c3d2689d | balrog | |
97 | c3d2689d | balrog | int enable;
|
98 | c3d2689d | balrog | int ptv;
|
99 | c3d2689d | balrog | int ar;
|
100 | c3d2689d | balrog | int st;
|
101 | c3d2689d | balrog | uint32_t reset_val; |
102 | c3d2689d | balrog | }; |
103 | c3d2689d | balrog | |
104 | c3d2689d | balrog | static inline uint32_t omap_timer_read(struct omap_mpu_timer_s *timer) |
105 | c3d2689d | balrog | { |
106 | 74475455 | Paolo Bonzini | uint64_t distance = qemu_get_clock_ns(vm_clock) - timer->time; |
107 | c3d2689d | balrog | |
108 | c3d2689d | balrog | if (timer->st && timer->enable && timer->rate)
|
109 | c3d2689d | balrog | return timer->val - muldiv64(distance >> (timer->ptv + 1), |
110 | 6ee093c9 | Juan Quintela | timer->rate, get_ticks_per_sec()); |
111 | c3d2689d | balrog | else
|
112 | c3d2689d | balrog | return timer->val;
|
113 | c3d2689d | balrog | } |
114 | c3d2689d | balrog | |
115 | c3d2689d | balrog | static inline void omap_timer_sync(struct omap_mpu_timer_s *timer) |
116 | c3d2689d | balrog | { |
117 | c3d2689d | balrog | timer->val = omap_timer_read(timer); |
118 | 74475455 | Paolo Bonzini | timer->time = qemu_get_clock_ns(vm_clock); |
119 | c3d2689d | balrog | } |
120 | c3d2689d | balrog | |
121 | c3d2689d | balrog | static inline void omap_timer_update(struct omap_mpu_timer_s *timer) |
122 | c3d2689d | balrog | { |
123 | c3d2689d | balrog | int64_t expires; |
124 | c3d2689d | balrog | |
125 | c3d2689d | balrog | if (timer->enable && timer->st && timer->rate) {
|
126 | c3d2689d | balrog | timer->val = timer->reset_val; /* Should skip this on clk enable */
|
127 | b8b137d6 | balrog | expires = muldiv64((uint64_t) timer->val << (timer->ptv + 1),
|
128 | 6ee093c9 | Juan Quintela | get_ticks_per_sec(), timer->rate); |
129 | b854bc19 | balrog | |
130 | b854bc19 | balrog | /* If timer expiry would be sooner than in about 1 ms and
|
131 | b854bc19 | balrog | * auto-reload isn't set, then fire immediately. This is a hack
|
132 | b854bc19 | balrog | * to make systems like PalmOS run in acceptable time. PalmOS
|
133 | b854bc19 | balrog | * sets the interval to a very low value and polls the status bit
|
134 | b854bc19 | balrog | * in a busy loop when it wants to sleep just a couple of CPU
|
135 | b854bc19 | balrog | * ticks. */
|
136 | 6ee093c9 | Juan Quintela | if (expires > (get_ticks_per_sec() >> 10) || timer->ar) |
137 | b854bc19 | balrog | qemu_mod_timer(timer->timer, timer->time + expires); |
138 | e856f2ad | balrog | else
|
139 | e856f2ad | balrog | qemu_bh_schedule(timer->tick); |
140 | c3d2689d | balrog | } else
|
141 | c3d2689d | balrog | qemu_del_timer(timer->timer); |
142 | c3d2689d | balrog | } |
143 | c3d2689d | balrog | |
144 | e856f2ad | balrog | static void omap_timer_fire(void *opaque) |
145 | c3d2689d | balrog | { |
146 | e856f2ad | balrog | struct omap_mpu_timer_s *timer = opaque;
|
147 | c3d2689d | balrog | |
148 | c3d2689d | balrog | if (!timer->ar) {
|
149 | c3d2689d | balrog | timer->val = 0;
|
150 | c3d2689d | balrog | timer->st = 0;
|
151 | c3d2689d | balrog | } |
152 | c3d2689d | balrog | |
153 | c3d2689d | balrog | if (timer->it_ena)
|
154 | 106627d0 | balrog | /* Edge-triggered irq */
|
155 | 106627d0 | balrog | qemu_irq_pulse(timer->irq); |
156 | e856f2ad | balrog | } |
157 | e856f2ad | balrog | |
158 | e856f2ad | balrog | static void omap_timer_tick(void *opaque) |
159 | e856f2ad | balrog | { |
160 | e856f2ad | balrog | struct omap_mpu_timer_s *timer = (struct omap_mpu_timer_s *) opaque; |
161 | e856f2ad | balrog | |
162 | e856f2ad | balrog | omap_timer_sync(timer); |
163 | e856f2ad | balrog | omap_timer_fire(timer); |
164 | c3d2689d | balrog | omap_timer_update(timer); |
165 | c3d2689d | balrog | } |
166 | c3d2689d | balrog | |
167 | c3d2689d | balrog | static void omap_timer_clk_update(void *opaque, int line, int on) |
168 | c3d2689d | balrog | { |
169 | c3d2689d | balrog | struct omap_mpu_timer_s *timer = (struct omap_mpu_timer_s *) opaque; |
170 | c3d2689d | balrog | |
171 | c3d2689d | balrog | omap_timer_sync(timer); |
172 | c3d2689d | balrog | timer->rate = on ? omap_clk_getrate(timer->clk) : 0;
|
173 | c3d2689d | balrog | omap_timer_update(timer); |
174 | c3d2689d | balrog | } |
175 | c3d2689d | balrog | |
176 | c3d2689d | balrog | static void omap_timer_clk_setup(struct omap_mpu_timer_s *timer) |
177 | c3d2689d | balrog | { |
178 | c3d2689d | balrog | omap_clk_adduser(timer->clk, |
179 | c3d2689d | balrog | qemu_allocate_irqs(omap_timer_clk_update, timer, 1)[0]); |
180 | c3d2689d | balrog | timer->rate = omap_clk_getrate(timer->clk); |
181 | c3d2689d | balrog | } |
182 | c3d2689d | balrog | |
183 | 4b3fedf3 | Avi Kivity | static uint64_t omap_mpu_timer_read(void *opaque, target_phys_addr_t addr, |
184 | 4b3fedf3 | Avi Kivity | unsigned size)
|
185 | c3d2689d | balrog | { |
186 | c3d2689d | balrog | struct omap_mpu_timer_s *s = (struct omap_mpu_timer_s *) opaque; |
187 | c3d2689d | balrog | |
188 | 4b3fedf3 | Avi Kivity | if (size != 4) { |
189 | 4b3fedf3 | Avi Kivity | return omap_badwidth_read32(opaque, addr);
|
190 | 4b3fedf3 | Avi Kivity | } |
191 | 4b3fedf3 | Avi Kivity | |
192 | 8da3ff18 | pbrook | switch (addr) {
|
193 | c3d2689d | balrog | case 0x00: /* CNTL_TIMER */ |
194 | c3d2689d | balrog | return (s->enable << 5) | (s->ptv << 2) | (s->ar << 1) | s->st; |
195 | c3d2689d | balrog | |
196 | c3d2689d | balrog | case 0x04: /* LOAD_TIM */ |
197 | c3d2689d | balrog | break;
|
198 | c3d2689d | balrog | |
199 | c3d2689d | balrog | case 0x08: /* READ_TIM */ |
200 | c3d2689d | balrog | return omap_timer_read(s);
|
201 | c3d2689d | balrog | } |
202 | c3d2689d | balrog | |
203 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
204 | c3d2689d | balrog | return 0; |
205 | c3d2689d | balrog | } |
206 | c3d2689d | balrog | |
207 | c227f099 | Anthony Liguori | static void omap_mpu_timer_write(void *opaque, target_phys_addr_t addr, |
208 | 4b3fedf3 | Avi Kivity | uint64_t value, unsigned size)
|
209 | c3d2689d | balrog | { |
210 | c3d2689d | balrog | struct omap_mpu_timer_s *s = (struct omap_mpu_timer_s *) opaque; |
211 | c3d2689d | balrog | |
212 | 4b3fedf3 | Avi Kivity | if (size != 4) { |
213 | 4b3fedf3 | Avi Kivity | return omap_badwidth_write32(opaque, addr, value);
|
214 | 4b3fedf3 | Avi Kivity | } |
215 | 4b3fedf3 | Avi Kivity | |
216 | 8da3ff18 | pbrook | switch (addr) {
|
217 | c3d2689d | balrog | case 0x00: /* CNTL_TIMER */ |
218 | c3d2689d | balrog | omap_timer_sync(s); |
219 | c3d2689d | balrog | s->enable = (value >> 5) & 1; |
220 | c3d2689d | balrog | s->ptv = (value >> 2) & 7; |
221 | c3d2689d | balrog | s->ar = (value >> 1) & 1; |
222 | c3d2689d | balrog | s->st = value & 1;
|
223 | c3d2689d | balrog | omap_timer_update(s); |
224 | c3d2689d | balrog | return;
|
225 | c3d2689d | balrog | |
226 | c3d2689d | balrog | case 0x04: /* LOAD_TIM */ |
227 | c3d2689d | balrog | s->reset_val = value; |
228 | c3d2689d | balrog | return;
|
229 | c3d2689d | balrog | |
230 | c3d2689d | balrog | case 0x08: /* READ_TIM */ |
231 | c3d2689d | balrog | OMAP_RO_REG(addr); |
232 | c3d2689d | balrog | break;
|
233 | c3d2689d | balrog | |
234 | c3d2689d | balrog | default:
|
235 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
236 | c3d2689d | balrog | } |
237 | c3d2689d | balrog | } |
238 | c3d2689d | balrog | |
239 | 4b3fedf3 | Avi Kivity | static const MemoryRegionOps omap_mpu_timer_ops = { |
240 | 4b3fedf3 | Avi Kivity | .read = omap_mpu_timer_read, |
241 | 4b3fedf3 | Avi Kivity | .write = omap_mpu_timer_write, |
242 | 4b3fedf3 | Avi Kivity | .endianness = DEVICE_LITTLE_ENDIAN, |
243 | c3d2689d | balrog | }; |
244 | c3d2689d | balrog | |
245 | c3d2689d | balrog | static void omap_mpu_timer_reset(struct omap_mpu_timer_s *s) |
246 | c3d2689d | balrog | { |
247 | c3d2689d | balrog | qemu_del_timer(s->timer); |
248 | c3d2689d | balrog | s->enable = 0;
|
249 | c3d2689d | balrog | s->reset_val = 31337;
|
250 | c3d2689d | balrog | s->val = 0;
|
251 | c3d2689d | balrog | s->ptv = 0;
|
252 | c3d2689d | balrog | s->ar = 0;
|
253 | c3d2689d | balrog | s->st = 0;
|
254 | c3d2689d | balrog | s->it_ena = 1;
|
255 | c3d2689d | balrog | } |
256 | c3d2689d | balrog | |
257 | 4b3fedf3 | Avi Kivity | static struct omap_mpu_timer_s *omap_mpu_timer_init(MemoryRegion *system_memory, |
258 | 4b3fedf3 | Avi Kivity | target_phys_addr_t base, |
259 | c3d2689d | balrog | qemu_irq irq, omap_clk clk) |
260 | c3d2689d | balrog | { |
261 | c3d2689d | balrog | struct omap_mpu_timer_s *s = (struct omap_mpu_timer_s *) |
262 | 7267c094 | Anthony Liguori | g_malloc0(sizeof(struct omap_mpu_timer_s)); |
263 | c3d2689d | balrog | |
264 | c3d2689d | balrog | s->irq = irq; |
265 | c3d2689d | balrog | s->clk = clk; |
266 | 74475455 | Paolo Bonzini | s->timer = qemu_new_timer_ns(vm_clock, omap_timer_tick, s); |
267 | e856f2ad | balrog | s->tick = qemu_bh_new(omap_timer_fire, s); |
268 | c3d2689d | balrog | omap_mpu_timer_reset(s); |
269 | c3d2689d | balrog | omap_timer_clk_setup(s); |
270 | c3d2689d | balrog | |
271 | 4b3fedf3 | Avi Kivity | memory_region_init_io(&s->iomem, &omap_mpu_timer_ops, s, |
272 | 4b3fedf3 | Avi Kivity | "omap-mpu-timer", 0x100); |
273 | 4b3fedf3 | Avi Kivity | |
274 | 4b3fedf3 | Avi Kivity | memory_region_add_subregion(system_memory, base, &s->iomem); |
275 | c3d2689d | balrog | |
276 | c3d2689d | balrog | return s;
|
277 | c3d2689d | balrog | } |
278 | c3d2689d | balrog | |
279 | c3d2689d | balrog | /* Watchdog timer */
|
280 | c3d2689d | balrog | struct omap_watchdog_timer_s {
|
281 | c3d2689d | balrog | struct omap_mpu_timer_s timer;
|
282 | 4b3fedf3 | Avi Kivity | MemoryRegion iomem; |
283 | c3d2689d | balrog | uint8_t last_wr; |
284 | c3d2689d | balrog | int mode;
|
285 | c3d2689d | balrog | int free;
|
286 | c3d2689d | balrog | int reset;
|
287 | c3d2689d | balrog | }; |
288 | c3d2689d | balrog | |
289 | 4b3fedf3 | Avi Kivity | static uint64_t omap_wd_timer_read(void *opaque, target_phys_addr_t addr, |
290 | 4b3fedf3 | Avi Kivity | unsigned size)
|
291 | c3d2689d | balrog | { |
292 | c3d2689d | balrog | struct omap_watchdog_timer_s *s = (struct omap_watchdog_timer_s *) opaque; |
293 | c3d2689d | balrog | |
294 | 4b3fedf3 | Avi Kivity | if (size != 2) { |
295 | 4b3fedf3 | Avi Kivity | return omap_badwidth_read16(opaque, addr);
|
296 | 4b3fedf3 | Avi Kivity | } |
297 | 4b3fedf3 | Avi Kivity | |
298 | 8da3ff18 | pbrook | switch (addr) {
|
299 | c3d2689d | balrog | case 0x00: /* CNTL_TIMER */ |
300 | c3d2689d | balrog | return (s->timer.ptv << 9) | (s->timer.ar << 8) | |
301 | c3d2689d | balrog | (s->timer.st << 7) | (s->free << 1); |
302 | c3d2689d | balrog | |
303 | c3d2689d | balrog | case 0x04: /* READ_TIMER */ |
304 | c3d2689d | balrog | return omap_timer_read(&s->timer);
|
305 | c3d2689d | balrog | |
306 | c3d2689d | balrog | case 0x08: /* TIMER_MODE */ |
307 | c3d2689d | balrog | return s->mode << 15; |
308 | c3d2689d | balrog | } |
309 | c3d2689d | balrog | |
310 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
311 | c3d2689d | balrog | return 0; |
312 | c3d2689d | balrog | } |
313 | c3d2689d | balrog | |
314 | c227f099 | Anthony Liguori | static void omap_wd_timer_write(void *opaque, target_phys_addr_t addr, |
315 | 4b3fedf3 | Avi Kivity | uint64_t value, unsigned size)
|
316 | c3d2689d | balrog | { |
317 | c3d2689d | balrog | struct omap_watchdog_timer_s *s = (struct omap_watchdog_timer_s *) opaque; |
318 | c3d2689d | balrog | |
319 | 4b3fedf3 | Avi Kivity | if (size != 2) { |
320 | 4b3fedf3 | Avi Kivity | return omap_badwidth_write16(opaque, addr, value);
|
321 | 4b3fedf3 | Avi Kivity | } |
322 | 4b3fedf3 | Avi Kivity | |
323 | 8da3ff18 | pbrook | switch (addr) {
|
324 | c3d2689d | balrog | case 0x00: /* CNTL_TIMER */ |
325 | c3d2689d | balrog | omap_timer_sync(&s->timer); |
326 | c3d2689d | balrog | s->timer.ptv = (value >> 9) & 7; |
327 | c3d2689d | balrog | s->timer.ar = (value >> 8) & 1; |
328 | c3d2689d | balrog | s->timer.st = (value >> 7) & 1; |
329 | c3d2689d | balrog | s->free = (value >> 1) & 1; |
330 | c3d2689d | balrog | omap_timer_update(&s->timer); |
331 | c3d2689d | balrog | break;
|
332 | c3d2689d | balrog | |
333 | c3d2689d | balrog | case 0x04: /* LOAD_TIMER */ |
334 | c3d2689d | balrog | s->timer.reset_val = value & 0xffff;
|
335 | c3d2689d | balrog | break;
|
336 | c3d2689d | balrog | |
337 | c3d2689d | balrog | case 0x08: /* TIMER_MODE */ |
338 | c3d2689d | balrog | if (!s->mode && ((value >> 15) & 1)) |
339 | c3d2689d | balrog | omap_clk_get(s->timer.clk); |
340 | c3d2689d | balrog | s->mode |= (value >> 15) & 1; |
341 | c3d2689d | balrog | if (s->last_wr == 0xf5) { |
342 | c3d2689d | balrog | if ((value & 0xff) == 0xa0) { |
343 | d8f699cb | balrog | if (s->mode) {
|
344 | d8f699cb | balrog | s->mode = 0;
|
345 | d8f699cb | balrog | omap_clk_put(s->timer.clk); |
346 | d8f699cb | balrog | } |
347 | c3d2689d | balrog | } else {
|
348 | c3d2689d | balrog | /* XXX: on T|E hardware somehow this has no effect,
|
349 | c3d2689d | balrog | * on Zire 71 it works as specified. */
|
350 | c3d2689d | balrog | s->reset = 1;
|
351 | c3d2689d | balrog | qemu_system_reset_request(); |
352 | c3d2689d | balrog | } |
353 | c3d2689d | balrog | } |
354 | c3d2689d | balrog | s->last_wr = value & 0xff;
|
355 | c3d2689d | balrog | break;
|
356 | c3d2689d | balrog | |
357 | c3d2689d | balrog | default:
|
358 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
359 | c3d2689d | balrog | } |
360 | c3d2689d | balrog | } |
361 | c3d2689d | balrog | |
362 | 4b3fedf3 | Avi Kivity | static const MemoryRegionOps omap_wd_timer_ops = { |
363 | 4b3fedf3 | Avi Kivity | .read = omap_wd_timer_read, |
364 | 4b3fedf3 | Avi Kivity | .write = omap_wd_timer_write, |
365 | 4b3fedf3 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
366 | c3d2689d | balrog | }; |
367 | c3d2689d | balrog | |
368 | c3d2689d | balrog | static void omap_wd_timer_reset(struct omap_watchdog_timer_s *s) |
369 | c3d2689d | balrog | { |
370 | c3d2689d | balrog | qemu_del_timer(s->timer.timer); |
371 | c3d2689d | balrog | if (!s->mode)
|
372 | c3d2689d | balrog | omap_clk_get(s->timer.clk); |
373 | c3d2689d | balrog | s->mode = 1;
|
374 | c3d2689d | balrog | s->free = 1;
|
375 | c3d2689d | balrog | s->reset = 0;
|
376 | c3d2689d | balrog | s->timer.enable = 1;
|
377 | c3d2689d | balrog | s->timer.it_ena = 1;
|
378 | c3d2689d | balrog | s->timer.reset_val = 0xffff;
|
379 | c3d2689d | balrog | s->timer.val = 0;
|
380 | c3d2689d | balrog | s->timer.st = 0;
|
381 | c3d2689d | balrog | s->timer.ptv = 0;
|
382 | c3d2689d | balrog | s->timer.ar = 0;
|
383 | c3d2689d | balrog | omap_timer_update(&s->timer); |
384 | c3d2689d | balrog | } |
385 | c3d2689d | balrog | |
386 | 4b3fedf3 | Avi Kivity | static struct omap_watchdog_timer_s *omap_wd_timer_init(MemoryRegion *memory, |
387 | 4b3fedf3 | Avi Kivity | target_phys_addr_t base, |
388 | c3d2689d | balrog | qemu_irq irq, omap_clk clk) |
389 | c3d2689d | balrog | { |
390 | c3d2689d | balrog | struct omap_watchdog_timer_s *s = (struct omap_watchdog_timer_s *) |
391 | 7267c094 | Anthony Liguori | g_malloc0(sizeof(struct omap_watchdog_timer_s)); |
392 | c3d2689d | balrog | |
393 | c3d2689d | balrog | s->timer.irq = irq; |
394 | c3d2689d | balrog | s->timer.clk = clk; |
395 | 74475455 | Paolo Bonzini | s->timer.timer = qemu_new_timer_ns(vm_clock, omap_timer_tick, &s->timer); |
396 | c3d2689d | balrog | omap_wd_timer_reset(s); |
397 | c3d2689d | balrog | omap_timer_clk_setup(&s->timer); |
398 | c3d2689d | balrog | |
399 | 4b3fedf3 | Avi Kivity | memory_region_init_io(&s->iomem, &omap_wd_timer_ops, s, |
400 | 4b3fedf3 | Avi Kivity | "omap-wd-timer", 0x100); |
401 | 4b3fedf3 | Avi Kivity | memory_region_add_subregion(memory, base, &s->iomem); |
402 | c3d2689d | balrog | |
403 | c3d2689d | balrog | return s;
|
404 | c3d2689d | balrog | } |
405 | c3d2689d | balrog | |
406 | c3d2689d | balrog | /* 32-kHz timer */
|
407 | c3d2689d | balrog | struct omap_32khz_timer_s {
|
408 | c3d2689d | balrog | struct omap_mpu_timer_s timer;
|
409 | 4b3fedf3 | Avi Kivity | MemoryRegion iomem; |
410 | c3d2689d | balrog | }; |
411 | c3d2689d | balrog | |
412 | 4b3fedf3 | Avi Kivity | static uint64_t omap_os_timer_read(void *opaque, target_phys_addr_t addr, |
413 | 4b3fedf3 | Avi Kivity | unsigned size)
|
414 | c3d2689d | balrog | { |
415 | c3d2689d | balrog | struct omap_32khz_timer_s *s = (struct omap_32khz_timer_s *) opaque; |
416 | cf965d24 | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
417 | c3d2689d | balrog | |
418 | 4b3fedf3 | Avi Kivity | if (size != 4) { |
419 | 4b3fedf3 | Avi Kivity | return omap_badwidth_read32(opaque, addr);
|
420 | 4b3fedf3 | Avi Kivity | } |
421 | 4b3fedf3 | Avi Kivity | |
422 | c3d2689d | balrog | switch (offset) {
|
423 | c3d2689d | balrog | case 0x00: /* TVR */ |
424 | c3d2689d | balrog | return s->timer.reset_val;
|
425 | c3d2689d | balrog | |
426 | c3d2689d | balrog | case 0x04: /* TCR */ |
427 | c3d2689d | balrog | return omap_timer_read(&s->timer);
|
428 | c3d2689d | balrog | |
429 | c3d2689d | balrog | case 0x08: /* CR */ |
430 | c3d2689d | balrog | return (s->timer.ar << 3) | (s->timer.it_ena << 2) | s->timer.st; |
431 | c3d2689d | balrog | |
432 | c3d2689d | balrog | default:
|
433 | c3d2689d | balrog | break;
|
434 | c3d2689d | balrog | } |
435 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
436 | c3d2689d | balrog | return 0; |
437 | c3d2689d | balrog | } |
438 | c3d2689d | balrog | |
439 | c227f099 | Anthony Liguori | static void omap_os_timer_write(void *opaque, target_phys_addr_t addr, |
440 | 4b3fedf3 | Avi Kivity | uint64_t value, unsigned size)
|
441 | c3d2689d | balrog | { |
442 | c3d2689d | balrog | struct omap_32khz_timer_s *s = (struct omap_32khz_timer_s *) opaque; |
443 | cf965d24 | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
444 | c3d2689d | balrog | |
445 | 4b3fedf3 | Avi Kivity | if (size != 4) { |
446 | 4b3fedf3 | Avi Kivity | return omap_badwidth_write32(opaque, addr, value);
|
447 | 4b3fedf3 | Avi Kivity | } |
448 | 4b3fedf3 | Avi Kivity | |
449 | c3d2689d | balrog | switch (offset) {
|
450 | c3d2689d | balrog | case 0x00: /* TVR */ |
451 | c3d2689d | balrog | s->timer.reset_val = value & 0x00ffffff;
|
452 | c3d2689d | balrog | break;
|
453 | c3d2689d | balrog | |
454 | c3d2689d | balrog | case 0x04: /* TCR */ |
455 | c3d2689d | balrog | OMAP_RO_REG(addr); |
456 | c3d2689d | balrog | break;
|
457 | c3d2689d | balrog | |
458 | c3d2689d | balrog | case 0x08: /* CR */ |
459 | c3d2689d | balrog | s->timer.ar = (value >> 3) & 1; |
460 | c3d2689d | balrog | s->timer.it_ena = (value >> 2) & 1; |
461 | c3d2689d | balrog | if (s->timer.st != (value & 1) || (value & 2)) { |
462 | c3d2689d | balrog | omap_timer_sync(&s->timer); |
463 | c3d2689d | balrog | s->timer.enable = value & 1;
|
464 | c3d2689d | balrog | s->timer.st = value & 1;
|
465 | c3d2689d | balrog | omap_timer_update(&s->timer); |
466 | c3d2689d | balrog | } |
467 | c3d2689d | balrog | break;
|
468 | c3d2689d | balrog | |
469 | c3d2689d | balrog | default:
|
470 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
471 | c3d2689d | balrog | } |
472 | c3d2689d | balrog | } |
473 | c3d2689d | balrog | |
474 | 4b3fedf3 | Avi Kivity | static const MemoryRegionOps omap_os_timer_ops = { |
475 | 4b3fedf3 | Avi Kivity | .read = omap_os_timer_read, |
476 | 4b3fedf3 | Avi Kivity | .write = omap_os_timer_write, |
477 | 4b3fedf3 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
478 | c3d2689d | balrog | }; |
479 | c3d2689d | balrog | |
480 | c3d2689d | balrog | static void omap_os_timer_reset(struct omap_32khz_timer_s *s) |
481 | c3d2689d | balrog | { |
482 | c3d2689d | balrog | qemu_del_timer(s->timer.timer); |
483 | c3d2689d | balrog | s->timer.enable = 0;
|
484 | c3d2689d | balrog | s->timer.it_ena = 0;
|
485 | c3d2689d | balrog | s->timer.reset_val = 0x00ffffff;
|
486 | c3d2689d | balrog | s->timer.val = 0;
|
487 | c3d2689d | balrog | s->timer.st = 0;
|
488 | c3d2689d | balrog | s->timer.ptv = 0;
|
489 | c3d2689d | balrog | s->timer.ar = 1;
|
490 | c3d2689d | balrog | } |
491 | c3d2689d | balrog | |
492 | 4b3fedf3 | Avi Kivity | static struct omap_32khz_timer_s *omap_os_timer_init(MemoryRegion *memory, |
493 | 4b3fedf3 | Avi Kivity | target_phys_addr_t base, |
494 | c3d2689d | balrog | qemu_irq irq, omap_clk clk) |
495 | c3d2689d | balrog | { |
496 | c3d2689d | balrog | struct omap_32khz_timer_s *s = (struct omap_32khz_timer_s *) |
497 | 7267c094 | Anthony Liguori | g_malloc0(sizeof(struct omap_32khz_timer_s)); |
498 | c3d2689d | balrog | |
499 | c3d2689d | balrog | s->timer.irq = irq; |
500 | c3d2689d | balrog | s->timer.clk = clk; |
501 | 74475455 | Paolo Bonzini | s->timer.timer = qemu_new_timer_ns(vm_clock, omap_timer_tick, &s->timer); |
502 | c3d2689d | balrog | omap_os_timer_reset(s); |
503 | c3d2689d | balrog | omap_timer_clk_setup(&s->timer); |
504 | c3d2689d | balrog | |
505 | 4b3fedf3 | Avi Kivity | memory_region_init_io(&s->iomem, &omap_os_timer_ops, s, |
506 | 4b3fedf3 | Avi Kivity | "omap-os-timer", 0x800); |
507 | 4b3fedf3 | Avi Kivity | memory_region_add_subregion(memory, base, &s->iomem); |
508 | c3d2689d | balrog | |
509 | c3d2689d | balrog | return s;
|
510 | c3d2689d | balrog | } |
511 | c3d2689d | balrog | |
512 | c3d2689d | balrog | /* Ultra Low-Power Device Module */
|
513 | 4b3fedf3 | Avi Kivity | static uint64_t omap_ulpd_pm_read(void *opaque, target_phys_addr_t addr, |
514 | 4b3fedf3 | Avi Kivity | unsigned size)
|
515 | c3d2689d | balrog | { |
516 | c3d2689d | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
517 | c3d2689d | balrog | uint16_t ret; |
518 | c3d2689d | balrog | |
519 | 4b3fedf3 | Avi Kivity | if (size != 2) { |
520 | 4b3fedf3 | Avi Kivity | return omap_badwidth_read16(opaque, addr);
|
521 | 4b3fedf3 | Avi Kivity | } |
522 | 4b3fedf3 | Avi Kivity | |
523 | 8da3ff18 | pbrook | switch (addr) {
|
524 | c3d2689d | balrog | case 0x14: /* IT_STATUS */ |
525 | 8da3ff18 | pbrook | ret = s->ulpd_pm_regs[addr >> 2];
|
526 | 8da3ff18 | pbrook | s->ulpd_pm_regs[addr >> 2] = 0; |
527 | 0919ac78 | Peter Maydell | qemu_irq_lower(qdev_get_gpio_in(s->ih[1], OMAP_INT_GAUGE_32K));
|
528 | c3d2689d | balrog | return ret;
|
529 | c3d2689d | balrog | |
530 | c3d2689d | balrog | case 0x18: /* Reserved */ |
531 | c3d2689d | balrog | case 0x1c: /* Reserved */ |
532 | c3d2689d | balrog | case 0x20: /* Reserved */ |
533 | c3d2689d | balrog | case 0x28: /* Reserved */ |
534 | c3d2689d | balrog | case 0x2c: /* Reserved */ |
535 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
536 | c3d2689d | balrog | case 0x00: /* COUNTER_32_LSB */ |
537 | c3d2689d | balrog | case 0x04: /* COUNTER_32_MSB */ |
538 | c3d2689d | balrog | case 0x08: /* COUNTER_HIGH_FREQ_LSB */ |
539 | c3d2689d | balrog | case 0x0c: /* COUNTER_HIGH_FREQ_MSB */ |
540 | c3d2689d | balrog | case 0x10: /* GAUGING_CTRL */ |
541 | c3d2689d | balrog | case 0x24: /* SETUP_ANALOG_CELL3_ULPD1 */ |
542 | c3d2689d | balrog | case 0x30: /* CLOCK_CTRL */ |
543 | c3d2689d | balrog | case 0x34: /* SOFT_REQ */ |
544 | c3d2689d | balrog | case 0x38: /* COUNTER_32_FIQ */ |
545 | c3d2689d | balrog | case 0x3c: /* DPLL_CTRL */ |
546 | c3d2689d | balrog | case 0x40: /* STATUS_REQ */ |
547 | c3d2689d | balrog | /* XXX: check clk::usecount state for every clock */
|
548 | c3d2689d | balrog | case 0x48: /* LOCL_TIME */ |
549 | c3d2689d | balrog | case 0x4c: /* APLL_CTRL */ |
550 | c3d2689d | balrog | case 0x50: /* POWER_CTRL */ |
551 | 8da3ff18 | pbrook | return s->ulpd_pm_regs[addr >> 2]; |
552 | c3d2689d | balrog | } |
553 | c3d2689d | balrog | |
554 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
555 | c3d2689d | balrog | return 0; |
556 | c3d2689d | balrog | } |
557 | c3d2689d | balrog | |
558 | c3d2689d | balrog | static inline void omap_ulpd_clk_update(struct omap_mpu_state_s *s, |
559 | c3d2689d | balrog | uint16_t diff, uint16_t value) |
560 | c3d2689d | balrog | { |
561 | c3d2689d | balrog | if (diff & (1 << 4)) /* USB_MCLK_EN */ |
562 | c3d2689d | balrog | omap_clk_onoff(omap_findclk(s, "usb_clk0"), (value >> 4) & 1); |
563 | c3d2689d | balrog | if (diff & (1 << 5)) /* DIS_USB_PVCI_CLK */ |
564 | c3d2689d | balrog | omap_clk_onoff(omap_findclk(s, "usb_w2fc_ck"), (~value >> 5) & 1); |
565 | c3d2689d | balrog | } |
566 | c3d2689d | balrog | |
567 | c3d2689d | balrog | static inline void omap_ulpd_req_update(struct omap_mpu_state_s *s, |
568 | c3d2689d | balrog | uint16_t diff, uint16_t value) |
569 | c3d2689d | balrog | { |
570 | c3d2689d | balrog | if (diff & (1 << 0)) /* SOFT_DPLL_REQ */ |
571 | c3d2689d | balrog | omap_clk_canidle(omap_findclk(s, "dpll4"), (~value >> 0) & 1); |
572 | c3d2689d | balrog | if (diff & (1 << 1)) /* SOFT_COM_REQ */ |
573 | c3d2689d | balrog | omap_clk_canidle(omap_findclk(s, "com_mclk_out"), (~value >> 1) & 1); |
574 | c3d2689d | balrog | if (diff & (1 << 2)) /* SOFT_SDW_REQ */ |
575 | c3d2689d | balrog | omap_clk_canidle(omap_findclk(s, "bt_mclk_out"), (~value >> 2) & 1); |
576 | c3d2689d | balrog | if (diff & (1 << 3)) /* SOFT_USB_REQ */ |
577 | c3d2689d | balrog | omap_clk_canidle(omap_findclk(s, "usb_clk0"), (~value >> 3) & 1); |
578 | c3d2689d | balrog | } |
579 | c3d2689d | balrog | |
580 | c227f099 | Anthony Liguori | static void omap_ulpd_pm_write(void *opaque, target_phys_addr_t addr, |
581 | 4b3fedf3 | Avi Kivity | uint64_t value, unsigned size)
|
582 | c3d2689d | balrog | { |
583 | c3d2689d | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
584 | c3d2689d | balrog | int64_t now, ticks; |
585 | c3d2689d | balrog | int div, mult;
|
586 | c3d2689d | balrog | static const int bypass_div[4] = { 1, 2, 4, 4 }; |
587 | c3d2689d | balrog | uint16_t diff; |
588 | c3d2689d | balrog | |
589 | 4b3fedf3 | Avi Kivity | if (size != 2) { |
590 | 4b3fedf3 | Avi Kivity | return omap_badwidth_write16(opaque, addr, value);
|
591 | 4b3fedf3 | Avi Kivity | } |
592 | 4b3fedf3 | Avi Kivity | |
593 | 8da3ff18 | pbrook | switch (addr) {
|
594 | c3d2689d | balrog | case 0x00: /* COUNTER_32_LSB */ |
595 | c3d2689d | balrog | case 0x04: /* COUNTER_32_MSB */ |
596 | c3d2689d | balrog | case 0x08: /* COUNTER_HIGH_FREQ_LSB */ |
597 | c3d2689d | balrog | case 0x0c: /* COUNTER_HIGH_FREQ_MSB */ |
598 | c3d2689d | balrog | case 0x14: /* IT_STATUS */ |
599 | c3d2689d | balrog | case 0x40: /* STATUS_REQ */ |
600 | c3d2689d | balrog | OMAP_RO_REG(addr); |
601 | c3d2689d | balrog | break;
|
602 | c3d2689d | balrog | |
603 | c3d2689d | balrog | case 0x10: /* GAUGING_CTRL */ |
604 | c3d2689d | balrog | /* Bits 0 and 1 seem to be confused in the OMAP 310 TRM */
|
605 | 8da3ff18 | pbrook | if ((s->ulpd_pm_regs[addr >> 2] ^ value) & 1) { |
606 | 74475455 | Paolo Bonzini | now = qemu_get_clock_ns(vm_clock); |
607 | c3d2689d | balrog | |
608 | c3d2689d | balrog | if (value & 1) |
609 | c3d2689d | balrog | s->ulpd_gauge_start = now; |
610 | c3d2689d | balrog | else {
|
611 | c3d2689d | balrog | now -= s->ulpd_gauge_start; |
612 | c3d2689d | balrog | |
613 | c3d2689d | balrog | /* 32-kHz ticks */
|
614 | 6ee093c9 | Juan Quintela | ticks = muldiv64(now, 32768, get_ticks_per_sec());
|
615 | c3d2689d | balrog | s->ulpd_pm_regs[0x00 >> 2] = (ticks >> 0) & 0xffff; |
616 | c3d2689d | balrog | s->ulpd_pm_regs[0x04 >> 2] = (ticks >> 16) & 0xffff; |
617 | c3d2689d | balrog | if (ticks >> 32) /* OVERFLOW_32K */ |
618 | c3d2689d | balrog | s->ulpd_pm_regs[0x14 >> 2] |= 1 << 2; |
619 | c3d2689d | balrog | |
620 | c3d2689d | balrog | /* High frequency ticks */
|
621 | 6ee093c9 | Juan Quintela | ticks = muldiv64(now, 12000000, get_ticks_per_sec());
|
622 | c3d2689d | balrog | s->ulpd_pm_regs[0x08 >> 2] = (ticks >> 0) & 0xffff; |
623 | c3d2689d | balrog | s->ulpd_pm_regs[0x0c >> 2] = (ticks >> 16) & 0xffff; |
624 | c3d2689d | balrog | if (ticks >> 32) /* OVERFLOW_HI_FREQ */ |
625 | c3d2689d | balrog | s->ulpd_pm_regs[0x14 >> 2] |= 1 << 1; |
626 | c3d2689d | balrog | |
627 | c3d2689d | balrog | s->ulpd_pm_regs[0x14 >> 2] |= 1 << 0; /* IT_GAUGING */ |
628 | 0919ac78 | Peter Maydell | qemu_irq_raise(qdev_get_gpio_in(s->ih[1], OMAP_INT_GAUGE_32K));
|
629 | c3d2689d | balrog | } |
630 | c3d2689d | balrog | } |
631 | 8da3ff18 | pbrook | s->ulpd_pm_regs[addr >> 2] = value;
|
632 | c3d2689d | balrog | break;
|
633 | c3d2689d | balrog | |
634 | c3d2689d | balrog | case 0x18: /* Reserved */ |
635 | c3d2689d | balrog | case 0x1c: /* Reserved */ |
636 | c3d2689d | balrog | case 0x20: /* Reserved */ |
637 | c3d2689d | balrog | case 0x28: /* Reserved */ |
638 | c3d2689d | balrog | case 0x2c: /* Reserved */ |
639 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
640 | c3d2689d | balrog | case 0x24: /* SETUP_ANALOG_CELL3_ULPD1 */ |
641 | c3d2689d | balrog | case 0x38: /* COUNTER_32_FIQ */ |
642 | c3d2689d | balrog | case 0x48: /* LOCL_TIME */ |
643 | c3d2689d | balrog | case 0x50: /* POWER_CTRL */ |
644 | 8da3ff18 | pbrook | s->ulpd_pm_regs[addr >> 2] = value;
|
645 | c3d2689d | balrog | break;
|
646 | c3d2689d | balrog | |
647 | c3d2689d | balrog | case 0x30: /* CLOCK_CTRL */ |
648 | 8da3ff18 | pbrook | diff = s->ulpd_pm_regs[addr >> 2] ^ value;
|
649 | 8da3ff18 | pbrook | s->ulpd_pm_regs[addr >> 2] = value & 0x3f; |
650 | c3d2689d | balrog | omap_ulpd_clk_update(s, diff, value); |
651 | c3d2689d | balrog | break;
|
652 | c3d2689d | balrog | |
653 | c3d2689d | balrog | case 0x34: /* SOFT_REQ */ |
654 | 8da3ff18 | pbrook | diff = s->ulpd_pm_regs[addr >> 2] ^ value;
|
655 | 8da3ff18 | pbrook | s->ulpd_pm_regs[addr >> 2] = value & 0x1f; |
656 | c3d2689d | balrog | omap_ulpd_req_update(s, diff, value); |
657 | c3d2689d | balrog | break;
|
658 | c3d2689d | balrog | |
659 | c3d2689d | balrog | case 0x3c: /* DPLL_CTRL */ |
660 | c3d2689d | balrog | /* XXX: OMAP310 TRM claims bit 3 is PLL_ENABLE, and bit 4 is
|
661 | c3d2689d | balrog | * omitted altogether, probably a typo. */
|
662 | c3d2689d | balrog | /* This register has identical semantics with DPLL(1:3) control
|
663 | c3d2689d | balrog | * registers, see omap_dpll_write() */
|
664 | 8da3ff18 | pbrook | diff = s->ulpd_pm_regs[addr >> 2] & value;
|
665 | 8da3ff18 | pbrook | s->ulpd_pm_regs[addr >> 2] = value & 0x2fff; |
666 | c3d2689d | balrog | if (diff & (0x3ff << 2)) { |
667 | c3d2689d | balrog | if (value & (1 << 4)) { /* PLL_ENABLE */ |
668 | c3d2689d | balrog | div = ((value >> 5) & 3) + 1; /* PLL_DIV */ |
669 | c3d2689d | balrog | mult = MIN((value >> 7) & 0x1f, 1); /* PLL_MULT */ |
670 | c3d2689d | balrog | } else {
|
671 | c3d2689d | balrog | div = bypass_div[((value >> 2) & 3)]; /* BYPASS_DIV */ |
672 | c3d2689d | balrog | mult = 1;
|
673 | c3d2689d | balrog | } |
674 | c3d2689d | balrog | omap_clk_setrate(omap_findclk(s, "dpll4"), div, mult);
|
675 | c3d2689d | balrog | } |
676 | c3d2689d | balrog | |
677 | c3d2689d | balrog | /* Enter the desired mode. */
|
678 | 8da3ff18 | pbrook | s->ulpd_pm_regs[addr >> 2] =
|
679 | 8da3ff18 | pbrook | (s->ulpd_pm_regs[addr >> 2] & 0xfffe) | |
680 | 8da3ff18 | pbrook | ((s->ulpd_pm_regs[addr >> 2] >> 4) & 1); |
681 | c3d2689d | balrog | |
682 | c3d2689d | balrog | /* Act as if the lock is restored. */
|
683 | 8da3ff18 | pbrook | s->ulpd_pm_regs[addr >> 2] |= 2; |
684 | c3d2689d | balrog | break;
|
685 | c3d2689d | balrog | |
686 | c3d2689d | balrog | case 0x4c: /* APLL_CTRL */ |
687 | 8da3ff18 | pbrook | diff = s->ulpd_pm_regs[addr >> 2] & value;
|
688 | 8da3ff18 | pbrook | s->ulpd_pm_regs[addr >> 2] = value & 0xf; |
689 | c3d2689d | balrog | if (diff & (1 << 0)) /* APLL_NDPLL_SWITCH */ |
690 | c3d2689d | balrog | omap_clk_reparent(omap_findclk(s, "ck_48m"), omap_findclk(s,
|
691 | c3d2689d | balrog | (value & (1 << 0)) ? "apll" : "dpll4")); |
692 | c3d2689d | balrog | break;
|
693 | c3d2689d | balrog | |
694 | c3d2689d | balrog | default:
|
695 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
696 | c3d2689d | balrog | } |
697 | c3d2689d | balrog | } |
698 | c3d2689d | balrog | |
699 | 4b3fedf3 | Avi Kivity | static const MemoryRegionOps omap_ulpd_pm_ops = { |
700 | 4b3fedf3 | Avi Kivity | .read = omap_ulpd_pm_read, |
701 | 4b3fedf3 | Avi Kivity | .write = omap_ulpd_pm_write, |
702 | 4b3fedf3 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
703 | c3d2689d | balrog | }; |
704 | c3d2689d | balrog | |
705 | c3d2689d | balrog | static void omap_ulpd_pm_reset(struct omap_mpu_state_s *mpu) |
706 | c3d2689d | balrog | { |
707 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x00 >> 2] = 0x0001; |
708 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x04 >> 2] = 0x0000; |
709 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x08 >> 2] = 0x0001; |
710 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x0c >> 2] = 0x0000; |
711 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x10 >> 2] = 0x0000; |
712 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x18 >> 2] = 0x01; |
713 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x1c >> 2] = 0x01; |
714 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x20 >> 2] = 0x01; |
715 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x24 >> 2] = 0x03ff; |
716 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x28 >> 2] = 0x01; |
717 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x2c >> 2] = 0x01; |
718 | c3d2689d | balrog | omap_ulpd_clk_update(mpu, mpu->ulpd_pm_regs[0x30 >> 2], 0x0000); |
719 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x30 >> 2] = 0x0000; |
720 | c3d2689d | balrog | omap_ulpd_req_update(mpu, mpu->ulpd_pm_regs[0x34 >> 2], 0x0000); |
721 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x34 >> 2] = 0x0000; |
722 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x38 >> 2] = 0x0001; |
723 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x3c >> 2] = 0x2211; |
724 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x40 >> 2] = 0x0000; /* FIXME: dump a real STATUS_REQ */ |
725 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x48 >> 2] = 0x960; |
726 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x4c >> 2] = 0x08; |
727 | c3d2689d | balrog | mpu->ulpd_pm_regs[0x50 >> 2] = 0x08; |
728 | c3d2689d | balrog | omap_clk_setrate(omap_findclk(mpu, "dpll4"), 1, 4); |
729 | c3d2689d | balrog | omap_clk_reparent(omap_findclk(mpu, "ck_48m"), omap_findclk(mpu, "dpll4")); |
730 | c3d2689d | balrog | } |
731 | c3d2689d | balrog | |
732 | 4b3fedf3 | Avi Kivity | static void omap_ulpd_pm_init(MemoryRegion *system_memory, |
733 | 4b3fedf3 | Avi Kivity | target_phys_addr_t base, |
734 | c3d2689d | balrog | struct omap_mpu_state_s *mpu)
|
735 | c3d2689d | balrog | { |
736 | 4b3fedf3 | Avi Kivity | memory_region_init_io(&mpu->ulpd_pm_iomem, &omap_ulpd_pm_ops, mpu, |
737 | 4b3fedf3 | Avi Kivity | "omap-ulpd-pm", 0x800); |
738 | 4b3fedf3 | Avi Kivity | memory_region_add_subregion(system_memory, base, &mpu->ulpd_pm_iomem); |
739 | c3d2689d | balrog | omap_ulpd_pm_reset(mpu); |
740 | c3d2689d | balrog | } |
741 | c3d2689d | balrog | |
742 | c3d2689d | balrog | /* OMAP Pin Configuration */
|
743 | 4b3fedf3 | Avi Kivity | static uint64_t omap_pin_cfg_read(void *opaque, target_phys_addr_t addr, |
744 | 4b3fedf3 | Avi Kivity | unsigned size)
|
745 | c3d2689d | balrog | { |
746 | c3d2689d | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
747 | c3d2689d | balrog | |
748 | 4b3fedf3 | Avi Kivity | if (size != 4) { |
749 | 4b3fedf3 | Avi Kivity | return omap_badwidth_read32(opaque, addr);
|
750 | 4b3fedf3 | Avi Kivity | } |
751 | 4b3fedf3 | Avi Kivity | |
752 | 8da3ff18 | pbrook | switch (addr) {
|
753 | c3d2689d | balrog | case 0x00: /* FUNC_MUX_CTRL_0 */ |
754 | c3d2689d | balrog | case 0x04: /* FUNC_MUX_CTRL_1 */ |
755 | c3d2689d | balrog | case 0x08: /* FUNC_MUX_CTRL_2 */ |
756 | 8da3ff18 | pbrook | return s->func_mux_ctrl[addr >> 2]; |
757 | c3d2689d | balrog | |
758 | c3d2689d | balrog | case 0x0c: /* COMP_MODE_CTRL_0 */ |
759 | c3d2689d | balrog | return s->comp_mode_ctrl[0]; |
760 | c3d2689d | balrog | |
761 | c3d2689d | balrog | case 0x10: /* FUNC_MUX_CTRL_3 */ |
762 | c3d2689d | balrog | case 0x14: /* FUNC_MUX_CTRL_4 */ |
763 | c3d2689d | balrog | case 0x18: /* FUNC_MUX_CTRL_5 */ |
764 | c3d2689d | balrog | case 0x1c: /* FUNC_MUX_CTRL_6 */ |
765 | c3d2689d | balrog | case 0x20: /* FUNC_MUX_CTRL_7 */ |
766 | c3d2689d | balrog | case 0x24: /* FUNC_MUX_CTRL_8 */ |
767 | c3d2689d | balrog | case 0x28: /* FUNC_MUX_CTRL_9 */ |
768 | c3d2689d | balrog | case 0x2c: /* FUNC_MUX_CTRL_A */ |
769 | c3d2689d | balrog | case 0x30: /* FUNC_MUX_CTRL_B */ |
770 | c3d2689d | balrog | case 0x34: /* FUNC_MUX_CTRL_C */ |
771 | c3d2689d | balrog | case 0x38: /* FUNC_MUX_CTRL_D */ |
772 | 8da3ff18 | pbrook | return s->func_mux_ctrl[(addr >> 2) - 1]; |
773 | c3d2689d | balrog | |
774 | c3d2689d | balrog | case 0x40: /* PULL_DWN_CTRL_0 */ |
775 | c3d2689d | balrog | case 0x44: /* PULL_DWN_CTRL_1 */ |
776 | c3d2689d | balrog | case 0x48: /* PULL_DWN_CTRL_2 */ |
777 | c3d2689d | balrog | case 0x4c: /* PULL_DWN_CTRL_3 */ |
778 | 8da3ff18 | pbrook | return s->pull_dwn_ctrl[(addr & 0xf) >> 2]; |
779 | c3d2689d | balrog | |
780 | c3d2689d | balrog | case 0x50: /* GATE_INH_CTRL_0 */ |
781 | c3d2689d | balrog | return s->gate_inh_ctrl[0]; |
782 | c3d2689d | balrog | |
783 | c3d2689d | balrog | case 0x60: /* VOLTAGE_CTRL_0 */ |
784 | c3d2689d | balrog | return s->voltage_ctrl[0]; |
785 | c3d2689d | balrog | |
786 | c3d2689d | balrog | case 0x70: /* TEST_DBG_CTRL_0 */ |
787 | c3d2689d | balrog | return s->test_dbg_ctrl[0]; |
788 | c3d2689d | balrog | |
789 | c3d2689d | balrog | case 0x80: /* MOD_CONF_CTRL_0 */ |
790 | c3d2689d | balrog | return s->mod_conf_ctrl[0]; |
791 | c3d2689d | balrog | } |
792 | c3d2689d | balrog | |
793 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
794 | c3d2689d | balrog | return 0; |
795 | c3d2689d | balrog | } |
796 | c3d2689d | balrog | |
797 | c3d2689d | balrog | static inline void omap_pin_funcmux0_update(struct omap_mpu_state_s *s, |
798 | c3d2689d | balrog | uint32_t diff, uint32_t value) |
799 | c3d2689d | balrog | { |
800 | c3d2689d | balrog | if (s->compat1509) {
|
801 | c3d2689d | balrog | if (diff & (1 << 9)) /* BLUETOOTH */ |
802 | c3d2689d | balrog | omap_clk_onoff(omap_findclk(s, "bt_mclk_out"),
|
803 | c3d2689d | balrog | (~value >> 9) & 1); |
804 | c3d2689d | balrog | if (diff & (1 << 7)) /* USB.CLKO */ |
805 | c3d2689d | balrog | omap_clk_onoff(omap_findclk(s, "usb.clko"),
|
806 | c3d2689d | balrog | (value >> 7) & 1); |
807 | c3d2689d | balrog | } |
808 | c3d2689d | balrog | } |
809 | c3d2689d | balrog | |
810 | c3d2689d | balrog | static inline void omap_pin_funcmux1_update(struct omap_mpu_state_s *s, |
811 | c3d2689d | balrog | uint32_t diff, uint32_t value) |
812 | c3d2689d | balrog | { |
813 | c3d2689d | balrog | if (s->compat1509) {
|
814 | c3d2689d | balrog | if (diff & (1 << 31)) /* MCBSP3_CLK_HIZ_DI */ |
815 | c3d2689d | balrog | omap_clk_onoff(omap_findclk(s, "mcbsp3.clkx"),
|
816 | c3d2689d | balrog | (value >> 31) & 1); |
817 | c3d2689d | balrog | if (diff & (1 << 1)) /* CLK32K */ |
818 | c3d2689d | balrog | omap_clk_onoff(omap_findclk(s, "clk32k_out"),
|
819 | c3d2689d | balrog | (~value >> 1) & 1); |
820 | c3d2689d | balrog | } |
821 | c3d2689d | balrog | } |
822 | c3d2689d | balrog | |
823 | c3d2689d | balrog | static inline void omap_pin_modconf1_update(struct omap_mpu_state_s *s, |
824 | c3d2689d | balrog | uint32_t diff, uint32_t value) |
825 | c3d2689d | balrog | { |
826 | c3d2689d | balrog | if (diff & (1 << 31)) /* CONF_MOD_UART3_CLK_MODE_R */ |
827 | c3d2689d | balrog | omap_clk_reparent(omap_findclk(s, "uart3_ck"),
|
828 | c3d2689d | balrog | omap_findclk(s, ((value >> 31) & 1) ? |
829 | c3d2689d | balrog | "ck_48m" : "armper_ck")); |
830 | c3d2689d | balrog | if (diff & (1 << 30)) /* CONF_MOD_UART2_CLK_MODE_R */ |
831 | c3d2689d | balrog | omap_clk_reparent(omap_findclk(s, "uart2_ck"),
|
832 | c3d2689d | balrog | omap_findclk(s, ((value >> 30) & 1) ? |
833 | c3d2689d | balrog | "ck_48m" : "armper_ck")); |
834 | c3d2689d | balrog | if (diff & (1 << 29)) /* CONF_MOD_UART1_CLK_MODE_R */ |
835 | c3d2689d | balrog | omap_clk_reparent(omap_findclk(s, "uart1_ck"),
|
836 | c3d2689d | balrog | omap_findclk(s, ((value >> 29) & 1) ? |
837 | c3d2689d | balrog | "ck_48m" : "armper_ck")); |
838 | c3d2689d | balrog | if (diff & (1 << 23)) /* CONF_MOD_MMC_SD_CLK_REQ_R */ |
839 | c3d2689d | balrog | omap_clk_reparent(omap_findclk(s, "mmc_ck"),
|
840 | c3d2689d | balrog | omap_findclk(s, ((value >> 23) & 1) ? |
841 | c3d2689d | balrog | "ck_48m" : "armper_ck")); |
842 | c3d2689d | balrog | if (diff & (1 << 12)) /* CONF_MOD_COM_MCLK_12_48_S */ |
843 | c3d2689d | balrog | omap_clk_reparent(omap_findclk(s, "com_mclk_out"),
|
844 | c3d2689d | balrog | omap_findclk(s, ((value >> 12) & 1) ? |
845 | c3d2689d | balrog | "ck_48m" : "armper_ck")); |
846 | c3d2689d | balrog | if (diff & (1 << 9)) /* CONF_MOD_USB_HOST_HHC_UHO */ |
847 | c3d2689d | balrog | omap_clk_onoff(omap_findclk(s, "usb_hhc_ck"), (value >> 9) & 1); |
848 | c3d2689d | balrog | } |
849 | c3d2689d | balrog | |
850 | c227f099 | Anthony Liguori | static void omap_pin_cfg_write(void *opaque, target_phys_addr_t addr, |
851 | 4b3fedf3 | Avi Kivity | uint64_t value, unsigned size)
|
852 | c3d2689d | balrog | { |
853 | c3d2689d | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
854 | c3d2689d | balrog | uint32_t diff; |
855 | c3d2689d | balrog | |
856 | 4b3fedf3 | Avi Kivity | if (size != 4) { |
857 | 4b3fedf3 | Avi Kivity | return omap_badwidth_write32(opaque, addr, value);
|
858 | 4b3fedf3 | Avi Kivity | } |
859 | 4b3fedf3 | Avi Kivity | |
860 | 8da3ff18 | pbrook | switch (addr) {
|
861 | c3d2689d | balrog | case 0x00: /* FUNC_MUX_CTRL_0 */ |
862 | 8da3ff18 | pbrook | diff = s->func_mux_ctrl[addr >> 2] ^ value;
|
863 | 8da3ff18 | pbrook | s->func_mux_ctrl[addr >> 2] = value;
|
864 | c3d2689d | balrog | omap_pin_funcmux0_update(s, diff, value); |
865 | c3d2689d | balrog | return;
|
866 | c3d2689d | balrog | |
867 | c3d2689d | balrog | case 0x04: /* FUNC_MUX_CTRL_1 */ |
868 | 8da3ff18 | pbrook | diff = s->func_mux_ctrl[addr >> 2] ^ value;
|
869 | 8da3ff18 | pbrook | s->func_mux_ctrl[addr >> 2] = value;
|
870 | c3d2689d | balrog | omap_pin_funcmux1_update(s, diff, value); |
871 | c3d2689d | balrog | return;
|
872 | c3d2689d | balrog | |
873 | c3d2689d | balrog | case 0x08: /* FUNC_MUX_CTRL_2 */ |
874 | 8da3ff18 | pbrook | s->func_mux_ctrl[addr >> 2] = value;
|
875 | c3d2689d | balrog | return;
|
876 | c3d2689d | balrog | |
877 | c3d2689d | balrog | case 0x0c: /* COMP_MODE_CTRL_0 */ |
878 | c3d2689d | balrog | s->comp_mode_ctrl[0] = value;
|
879 | c3d2689d | balrog | s->compat1509 = (value != 0x0000eaef);
|
880 | c3d2689d | balrog | omap_pin_funcmux0_update(s, ~0, s->func_mux_ctrl[0]); |
881 | c3d2689d | balrog | omap_pin_funcmux1_update(s, ~0, s->func_mux_ctrl[1]); |
882 | c3d2689d | balrog | return;
|
883 | c3d2689d | balrog | |
884 | c3d2689d | balrog | case 0x10: /* FUNC_MUX_CTRL_3 */ |
885 | c3d2689d | balrog | case 0x14: /* FUNC_MUX_CTRL_4 */ |
886 | c3d2689d | balrog | case 0x18: /* FUNC_MUX_CTRL_5 */ |
887 | c3d2689d | balrog | case 0x1c: /* FUNC_MUX_CTRL_6 */ |
888 | c3d2689d | balrog | case 0x20: /* FUNC_MUX_CTRL_7 */ |
889 | c3d2689d | balrog | case 0x24: /* FUNC_MUX_CTRL_8 */ |
890 | c3d2689d | balrog | case 0x28: /* FUNC_MUX_CTRL_9 */ |
891 | c3d2689d | balrog | case 0x2c: /* FUNC_MUX_CTRL_A */ |
892 | c3d2689d | balrog | case 0x30: /* FUNC_MUX_CTRL_B */ |
893 | c3d2689d | balrog | case 0x34: /* FUNC_MUX_CTRL_C */ |
894 | c3d2689d | balrog | case 0x38: /* FUNC_MUX_CTRL_D */ |
895 | 8da3ff18 | pbrook | s->func_mux_ctrl[(addr >> 2) - 1] = value; |
896 | c3d2689d | balrog | return;
|
897 | c3d2689d | balrog | |
898 | c3d2689d | balrog | case 0x40: /* PULL_DWN_CTRL_0 */ |
899 | c3d2689d | balrog | case 0x44: /* PULL_DWN_CTRL_1 */ |
900 | c3d2689d | balrog | case 0x48: /* PULL_DWN_CTRL_2 */ |
901 | c3d2689d | balrog | case 0x4c: /* PULL_DWN_CTRL_3 */ |
902 | 8da3ff18 | pbrook | s->pull_dwn_ctrl[(addr & 0xf) >> 2] = value; |
903 | c3d2689d | balrog | return;
|
904 | c3d2689d | balrog | |
905 | c3d2689d | balrog | case 0x50: /* GATE_INH_CTRL_0 */ |
906 | c3d2689d | balrog | s->gate_inh_ctrl[0] = value;
|
907 | c3d2689d | balrog | return;
|
908 | c3d2689d | balrog | |
909 | c3d2689d | balrog | case 0x60: /* VOLTAGE_CTRL_0 */ |
910 | c3d2689d | balrog | s->voltage_ctrl[0] = value;
|
911 | c3d2689d | balrog | return;
|
912 | c3d2689d | balrog | |
913 | c3d2689d | balrog | case 0x70: /* TEST_DBG_CTRL_0 */ |
914 | c3d2689d | balrog | s->test_dbg_ctrl[0] = value;
|
915 | c3d2689d | balrog | return;
|
916 | c3d2689d | balrog | |
917 | c3d2689d | balrog | case 0x80: /* MOD_CONF_CTRL_0 */ |
918 | c3d2689d | balrog | diff = s->mod_conf_ctrl[0] ^ value;
|
919 | c3d2689d | balrog | s->mod_conf_ctrl[0] = value;
|
920 | c3d2689d | balrog | omap_pin_modconf1_update(s, diff, value); |
921 | c3d2689d | balrog | return;
|
922 | c3d2689d | balrog | |
923 | c3d2689d | balrog | default:
|
924 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
925 | c3d2689d | balrog | } |
926 | c3d2689d | balrog | } |
927 | c3d2689d | balrog | |
928 | 4b3fedf3 | Avi Kivity | static const MemoryRegionOps omap_pin_cfg_ops = { |
929 | 4b3fedf3 | Avi Kivity | .read = omap_pin_cfg_read, |
930 | 4b3fedf3 | Avi Kivity | .write = omap_pin_cfg_write, |
931 | 4b3fedf3 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
932 | c3d2689d | balrog | }; |
933 | c3d2689d | balrog | |
934 | c3d2689d | balrog | static void omap_pin_cfg_reset(struct omap_mpu_state_s *mpu) |
935 | c3d2689d | balrog | { |
936 | c3d2689d | balrog | /* Start in Compatibility Mode. */
|
937 | c3d2689d | balrog | mpu->compat1509 = 1;
|
938 | c3d2689d | balrog | omap_pin_funcmux0_update(mpu, mpu->func_mux_ctrl[0], 0); |
939 | c3d2689d | balrog | omap_pin_funcmux1_update(mpu, mpu->func_mux_ctrl[1], 0); |
940 | c3d2689d | balrog | omap_pin_modconf1_update(mpu, mpu->mod_conf_ctrl[0], 0); |
941 | c3d2689d | balrog | memset(mpu->func_mux_ctrl, 0, sizeof(mpu->func_mux_ctrl)); |
942 | c3d2689d | balrog | memset(mpu->comp_mode_ctrl, 0, sizeof(mpu->comp_mode_ctrl)); |
943 | c3d2689d | balrog | memset(mpu->pull_dwn_ctrl, 0, sizeof(mpu->pull_dwn_ctrl)); |
944 | c3d2689d | balrog | memset(mpu->gate_inh_ctrl, 0, sizeof(mpu->gate_inh_ctrl)); |
945 | c3d2689d | balrog | memset(mpu->voltage_ctrl, 0, sizeof(mpu->voltage_ctrl)); |
946 | c3d2689d | balrog | memset(mpu->test_dbg_ctrl, 0, sizeof(mpu->test_dbg_ctrl)); |
947 | c3d2689d | balrog | memset(mpu->mod_conf_ctrl, 0, sizeof(mpu->mod_conf_ctrl)); |
948 | c3d2689d | balrog | } |
949 | c3d2689d | balrog | |
950 | 4b3fedf3 | Avi Kivity | static void omap_pin_cfg_init(MemoryRegion *system_memory, |
951 | 4b3fedf3 | Avi Kivity | target_phys_addr_t base, |
952 | c3d2689d | balrog | struct omap_mpu_state_s *mpu)
|
953 | c3d2689d | balrog | { |
954 | 4b3fedf3 | Avi Kivity | memory_region_init_io(&mpu->pin_cfg_iomem, &omap_pin_cfg_ops, mpu, |
955 | 4b3fedf3 | Avi Kivity | "omap-pin-cfg", 0x800); |
956 | 4b3fedf3 | Avi Kivity | memory_region_add_subregion(system_memory, base, &mpu->pin_cfg_iomem); |
957 | c3d2689d | balrog | omap_pin_cfg_reset(mpu); |
958 | c3d2689d | balrog | } |
959 | c3d2689d | balrog | |
960 | c3d2689d | balrog | /* Device Identification, Die Identification */
|
961 | 4b3fedf3 | Avi Kivity | static uint64_t omap_id_read(void *opaque, target_phys_addr_t addr, |
962 | 4b3fedf3 | Avi Kivity | unsigned size)
|
963 | c3d2689d | balrog | { |
964 | c3d2689d | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
965 | c3d2689d | balrog | |
966 | 4b3fedf3 | Avi Kivity | if (size != 4) { |
967 | 4b3fedf3 | Avi Kivity | return omap_badwidth_read32(opaque, addr);
|
968 | 4b3fedf3 | Avi Kivity | } |
969 | 4b3fedf3 | Avi Kivity | |
970 | c3d2689d | balrog | switch (addr) {
|
971 | c3d2689d | balrog | case 0xfffe1800: /* DIE_ID_LSB */ |
972 | c3d2689d | balrog | return 0xc9581f0e; |
973 | c3d2689d | balrog | case 0xfffe1804: /* DIE_ID_MSB */ |
974 | c3d2689d | balrog | return 0xa8858bfa; |
975 | c3d2689d | balrog | |
976 | c3d2689d | balrog | case 0xfffe2000: /* PRODUCT_ID_LSB */ |
977 | c3d2689d | balrog | return 0x00aaaafc; |
978 | c3d2689d | balrog | case 0xfffe2004: /* PRODUCT_ID_MSB */ |
979 | c3d2689d | balrog | return 0xcafeb574; |
980 | c3d2689d | balrog | |
981 | c3d2689d | balrog | case 0xfffed400: /* JTAG_ID_LSB */ |
982 | c3d2689d | balrog | switch (s->mpu_model) {
|
983 | c3d2689d | balrog | case omap310:
|
984 | c3d2689d | balrog | return 0x03310315; |
985 | c3d2689d | balrog | case omap1510:
|
986 | c3d2689d | balrog | return 0x03310115; |
987 | 827df9f3 | balrog | default:
|
988 | 2ac71179 | Paul Brook | hw_error("%s: bad mpu model\n", __FUNCTION__);
|
989 | c3d2689d | balrog | } |
990 | c3d2689d | balrog | break;
|
991 | c3d2689d | balrog | |
992 | c3d2689d | balrog | case 0xfffed404: /* JTAG_ID_MSB */ |
993 | c3d2689d | balrog | switch (s->mpu_model) {
|
994 | c3d2689d | balrog | case omap310:
|
995 | c3d2689d | balrog | return 0xfb57402f; |
996 | c3d2689d | balrog | case omap1510:
|
997 | c3d2689d | balrog | return 0xfb47002f; |
998 | 827df9f3 | balrog | default:
|
999 | 2ac71179 | Paul Brook | hw_error("%s: bad mpu model\n", __FUNCTION__);
|
1000 | c3d2689d | balrog | } |
1001 | c3d2689d | balrog | break;
|
1002 | c3d2689d | balrog | } |
1003 | c3d2689d | balrog | |
1004 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
1005 | c3d2689d | balrog | return 0; |
1006 | c3d2689d | balrog | } |
1007 | c3d2689d | balrog | |
1008 | c227f099 | Anthony Liguori | static void omap_id_write(void *opaque, target_phys_addr_t addr, |
1009 | 4b3fedf3 | Avi Kivity | uint64_t value, unsigned size)
|
1010 | c3d2689d | balrog | { |
1011 | 4b3fedf3 | Avi Kivity | if (size != 4) { |
1012 | 4b3fedf3 | Avi Kivity | return omap_badwidth_write32(opaque, addr, value);
|
1013 | 4b3fedf3 | Avi Kivity | } |
1014 | 4b3fedf3 | Avi Kivity | |
1015 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
1016 | c3d2689d | balrog | } |
1017 | c3d2689d | balrog | |
1018 | 4b3fedf3 | Avi Kivity | static const MemoryRegionOps omap_id_ops = { |
1019 | 4b3fedf3 | Avi Kivity | .read = omap_id_read, |
1020 | 4b3fedf3 | Avi Kivity | .write = omap_id_write, |
1021 | 4b3fedf3 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
1022 | c3d2689d | balrog | }; |
1023 | c3d2689d | balrog | |
1024 | 4b3fedf3 | Avi Kivity | static void omap_id_init(MemoryRegion *memory, struct omap_mpu_state_s *mpu) |
1025 | c3d2689d | balrog | { |
1026 | 4b3fedf3 | Avi Kivity | memory_region_init_io(&mpu->id_iomem, &omap_id_ops, mpu, |
1027 | 4b3fedf3 | Avi Kivity | "omap-id", 0x100000000ULL); |
1028 | 4b3fedf3 | Avi Kivity | memory_region_init_alias(&mpu->id_iomem_e18, "omap-id-e18", &mpu->id_iomem,
|
1029 | 4b3fedf3 | Avi Kivity | 0xfffe1800, 0x800); |
1030 | 4b3fedf3 | Avi Kivity | memory_region_add_subregion(memory, 0xfffe1800, &mpu->id_iomem_e18);
|
1031 | 4b3fedf3 | Avi Kivity | memory_region_init_alias(&mpu->id_iomem_ed4, "omap-id-ed4", &mpu->id_iomem,
|
1032 | 4b3fedf3 | Avi Kivity | 0xfffed400, 0x100); |
1033 | 4b3fedf3 | Avi Kivity | memory_region_add_subregion(memory, 0xfffed400, &mpu->id_iomem_ed4);
|
1034 | 4b3fedf3 | Avi Kivity | if (!cpu_is_omap15xx(mpu)) {
|
1035 | 4b3fedf3 | Avi Kivity | memory_region_init_alias(&mpu->id_iomem_ed4, "omap-id-e20",
|
1036 | 4b3fedf3 | Avi Kivity | &mpu->id_iomem, 0xfffe2000, 0x800); |
1037 | 4b3fedf3 | Avi Kivity | memory_region_add_subregion(memory, 0xfffe2000, &mpu->id_iomem_e20);
|
1038 | 4b3fedf3 | Avi Kivity | } |
1039 | c3d2689d | balrog | } |
1040 | c3d2689d | balrog | |
1041 | c3d2689d | balrog | /* MPUI Control (Dummy) */
|
1042 | 4b3fedf3 | Avi Kivity | static uint64_t omap_mpui_read(void *opaque, target_phys_addr_t addr, |
1043 | 4b3fedf3 | Avi Kivity | unsigned size)
|
1044 | c3d2689d | balrog | { |
1045 | c3d2689d | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
1046 | c3d2689d | balrog | |
1047 | 4b3fedf3 | Avi Kivity | if (size != 4) { |
1048 | 4b3fedf3 | Avi Kivity | return omap_badwidth_read32(opaque, addr);
|
1049 | 4b3fedf3 | Avi Kivity | } |
1050 | 4b3fedf3 | Avi Kivity | |
1051 | 8da3ff18 | pbrook | switch (addr) {
|
1052 | c3d2689d | balrog | case 0x00: /* CTRL */ |
1053 | c3d2689d | balrog | return s->mpui_ctrl;
|
1054 | c3d2689d | balrog | case 0x04: /* DEBUG_ADDR */ |
1055 | c3d2689d | balrog | return 0x01ffffff; |
1056 | c3d2689d | balrog | case 0x08: /* DEBUG_DATA */ |
1057 | c3d2689d | balrog | return 0xffffffff; |
1058 | c3d2689d | balrog | case 0x0c: /* DEBUG_FLAG */ |
1059 | c3d2689d | balrog | return 0x00000800; |
1060 | c3d2689d | balrog | case 0x10: /* STATUS */ |
1061 | c3d2689d | balrog | return 0x00000000; |
1062 | c3d2689d | balrog | |
1063 | c3d2689d | balrog | /* Not in OMAP310 */
|
1064 | c3d2689d | balrog | case 0x14: /* DSP_STATUS */ |
1065 | c3d2689d | balrog | case 0x18: /* DSP_BOOT_CONFIG */ |
1066 | c3d2689d | balrog | return 0x00000000; |
1067 | c3d2689d | balrog | case 0x1c: /* DSP_MPUI_CONFIG */ |
1068 | c3d2689d | balrog | return 0x0000ffff; |
1069 | c3d2689d | balrog | } |
1070 | c3d2689d | balrog | |
1071 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
1072 | c3d2689d | balrog | return 0; |
1073 | c3d2689d | balrog | } |
1074 | c3d2689d | balrog | |
1075 | c227f099 | Anthony Liguori | static void omap_mpui_write(void *opaque, target_phys_addr_t addr, |
1076 | 4b3fedf3 | Avi Kivity | uint64_t value, unsigned size)
|
1077 | c3d2689d | balrog | { |
1078 | c3d2689d | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
1079 | c3d2689d | balrog | |
1080 | 4b3fedf3 | Avi Kivity | if (size != 4) { |
1081 | 4b3fedf3 | Avi Kivity | return omap_badwidth_write32(opaque, addr, value);
|
1082 | 4b3fedf3 | Avi Kivity | } |
1083 | 4b3fedf3 | Avi Kivity | |
1084 | 8da3ff18 | pbrook | switch (addr) {
|
1085 | c3d2689d | balrog | case 0x00: /* CTRL */ |
1086 | c3d2689d | balrog | s->mpui_ctrl = value & 0x007fffff;
|
1087 | c3d2689d | balrog | break;
|
1088 | c3d2689d | balrog | |
1089 | c3d2689d | balrog | case 0x04: /* DEBUG_ADDR */ |
1090 | c3d2689d | balrog | case 0x08: /* DEBUG_DATA */ |
1091 | c3d2689d | balrog | case 0x0c: /* DEBUG_FLAG */ |
1092 | c3d2689d | balrog | case 0x10: /* STATUS */ |
1093 | c3d2689d | balrog | /* Not in OMAP310 */
|
1094 | c3d2689d | balrog | case 0x14: /* DSP_STATUS */ |
1095 | c3d2689d | balrog | OMAP_RO_REG(addr); |
1096 | c3d2689d | balrog | case 0x18: /* DSP_BOOT_CONFIG */ |
1097 | c3d2689d | balrog | case 0x1c: /* DSP_MPUI_CONFIG */ |
1098 | c3d2689d | balrog | break;
|
1099 | c3d2689d | balrog | |
1100 | c3d2689d | balrog | default:
|
1101 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
1102 | c3d2689d | balrog | } |
1103 | c3d2689d | balrog | } |
1104 | c3d2689d | balrog | |
1105 | 4b3fedf3 | Avi Kivity | static const MemoryRegionOps omap_mpui_ops = { |
1106 | 4b3fedf3 | Avi Kivity | .read = omap_mpui_read, |
1107 | 4b3fedf3 | Avi Kivity | .write = omap_mpui_write, |
1108 | 4b3fedf3 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
1109 | c3d2689d | balrog | }; |
1110 | c3d2689d | balrog | |
1111 | c3d2689d | balrog | static void omap_mpui_reset(struct omap_mpu_state_s *s) |
1112 | c3d2689d | balrog | { |
1113 | c3d2689d | balrog | s->mpui_ctrl = 0x0003ff1b;
|
1114 | c3d2689d | balrog | } |
1115 | c3d2689d | balrog | |
1116 | 4b3fedf3 | Avi Kivity | static void omap_mpui_init(MemoryRegion *memory, target_phys_addr_t base, |
1117 | c3d2689d | balrog | struct omap_mpu_state_s *mpu)
|
1118 | c3d2689d | balrog | { |
1119 | 4b3fedf3 | Avi Kivity | memory_region_init_io(&mpu->mpui_iomem, &omap_mpui_ops, mpu, |
1120 | 4b3fedf3 | Avi Kivity | "omap-mpui", 0x100); |
1121 | 4b3fedf3 | Avi Kivity | memory_region_add_subregion(memory, base, &mpu->mpui_iomem); |
1122 | c3d2689d | balrog | |
1123 | c3d2689d | balrog | omap_mpui_reset(mpu); |
1124 | c3d2689d | balrog | } |
1125 | c3d2689d | balrog | |
1126 | c3d2689d | balrog | /* TIPB Bridges */
|
1127 | c3d2689d | balrog | struct omap_tipb_bridge_s {
|
1128 | c3d2689d | balrog | qemu_irq abort; |
1129 | 4b3fedf3 | Avi Kivity | MemoryRegion iomem; |
1130 | c3d2689d | balrog | |
1131 | c3d2689d | balrog | int width_intr;
|
1132 | c3d2689d | balrog | uint16_t control; |
1133 | c3d2689d | balrog | uint16_t alloc; |
1134 | c3d2689d | balrog | uint16_t buffer; |
1135 | c3d2689d | balrog | uint16_t enh_control; |
1136 | c3d2689d | balrog | }; |
1137 | c3d2689d | balrog | |
1138 | 4b3fedf3 | Avi Kivity | static uint64_t omap_tipb_bridge_read(void *opaque, target_phys_addr_t addr, |
1139 | 4b3fedf3 | Avi Kivity | unsigned size)
|
1140 | c3d2689d | balrog | { |
1141 | c3d2689d | balrog | struct omap_tipb_bridge_s *s = (struct omap_tipb_bridge_s *) opaque; |
1142 | c3d2689d | balrog | |
1143 | 4b3fedf3 | Avi Kivity | if (size < 2) { |
1144 | 4b3fedf3 | Avi Kivity | return omap_badwidth_read16(opaque, addr);
|
1145 | 4b3fedf3 | Avi Kivity | } |
1146 | 4b3fedf3 | Avi Kivity | |
1147 | 8da3ff18 | pbrook | switch (addr) {
|
1148 | c3d2689d | balrog | case 0x00: /* TIPB_CNTL */ |
1149 | c3d2689d | balrog | return s->control;
|
1150 | c3d2689d | balrog | case 0x04: /* TIPB_BUS_ALLOC */ |
1151 | c3d2689d | balrog | return s->alloc;
|
1152 | c3d2689d | balrog | case 0x08: /* MPU_TIPB_CNTL */ |
1153 | c3d2689d | balrog | return s->buffer;
|
1154 | c3d2689d | balrog | case 0x0c: /* ENHANCED_TIPB_CNTL */ |
1155 | c3d2689d | balrog | return s->enh_control;
|
1156 | c3d2689d | balrog | case 0x10: /* ADDRESS_DBG */ |
1157 | c3d2689d | balrog | case 0x14: /* DATA_DEBUG_LOW */ |
1158 | c3d2689d | balrog | case 0x18: /* DATA_DEBUG_HIGH */ |
1159 | c3d2689d | balrog | return 0xffff; |
1160 | c3d2689d | balrog | case 0x1c: /* DEBUG_CNTR_SIG */ |
1161 | c3d2689d | balrog | return 0x00f8; |
1162 | c3d2689d | balrog | } |
1163 | c3d2689d | balrog | |
1164 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
1165 | c3d2689d | balrog | return 0; |
1166 | c3d2689d | balrog | } |
1167 | c3d2689d | balrog | |
1168 | c227f099 | Anthony Liguori | static void omap_tipb_bridge_write(void *opaque, target_phys_addr_t addr, |
1169 | 4b3fedf3 | Avi Kivity | uint64_t value, unsigned size)
|
1170 | c3d2689d | balrog | { |
1171 | c3d2689d | balrog | struct omap_tipb_bridge_s *s = (struct omap_tipb_bridge_s *) opaque; |
1172 | c3d2689d | balrog | |
1173 | 4b3fedf3 | Avi Kivity | if (size < 2) { |
1174 | 4b3fedf3 | Avi Kivity | return omap_badwidth_write16(opaque, addr, value);
|
1175 | 4b3fedf3 | Avi Kivity | } |
1176 | 4b3fedf3 | Avi Kivity | |
1177 | 8da3ff18 | pbrook | switch (addr) {
|
1178 | c3d2689d | balrog | case 0x00: /* TIPB_CNTL */ |
1179 | c3d2689d | balrog | s->control = value & 0xffff;
|
1180 | c3d2689d | balrog | break;
|
1181 | c3d2689d | balrog | |
1182 | c3d2689d | balrog | case 0x04: /* TIPB_BUS_ALLOC */ |
1183 | c3d2689d | balrog | s->alloc = value & 0x003f;
|
1184 | c3d2689d | balrog | break;
|
1185 | c3d2689d | balrog | |
1186 | c3d2689d | balrog | case 0x08: /* MPU_TIPB_CNTL */ |
1187 | c3d2689d | balrog | s->buffer = value & 0x0003;
|
1188 | c3d2689d | balrog | break;
|
1189 | c3d2689d | balrog | |
1190 | c3d2689d | balrog | case 0x0c: /* ENHANCED_TIPB_CNTL */ |
1191 | c3d2689d | balrog | s->width_intr = !(value & 2);
|
1192 | c3d2689d | balrog | s->enh_control = value & 0x000f;
|
1193 | c3d2689d | balrog | break;
|
1194 | c3d2689d | balrog | |
1195 | c3d2689d | balrog | case 0x10: /* ADDRESS_DBG */ |
1196 | c3d2689d | balrog | case 0x14: /* DATA_DEBUG_LOW */ |
1197 | c3d2689d | balrog | case 0x18: /* DATA_DEBUG_HIGH */ |
1198 | c3d2689d | balrog | case 0x1c: /* DEBUG_CNTR_SIG */ |
1199 | c3d2689d | balrog | OMAP_RO_REG(addr); |
1200 | c3d2689d | balrog | break;
|
1201 | c3d2689d | balrog | |
1202 | c3d2689d | balrog | default:
|
1203 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
1204 | c3d2689d | balrog | } |
1205 | c3d2689d | balrog | } |
1206 | c3d2689d | balrog | |
1207 | 4b3fedf3 | Avi Kivity | static const MemoryRegionOps omap_tipb_bridge_ops = { |
1208 | 4b3fedf3 | Avi Kivity | .read = omap_tipb_bridge_read, |
1209 | 4b3fedf3 | Avi Kivity | .write = omap_tipb_bridge_write, |
1210 | 4b3fedf3 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
1211 | c3d2689d | balrog | }; |
1212 | c3d2689d | balrog | |
1213 | c3d2689d | balrog | static void omap_tipb_bridge_reset(struct omap_tipb_bridge_s *s) |
1214 | c3d2689d | balrog | { |
1215 | c3d2689d | balrog | s->control = 0xffff;
|
1216 | c3d2689d | balrog | s->alloc = 0x0009;
|
1217 | c3d2689d | balrog | s->buffer = 0x0000;
|
1218 | c3d2689d | balrog | s->enh_control = 0x000f;
|
1219 | c3d2689d | balrog | } |
1220 | c3d2689d | balrog | |
1221 | 4b3fedf3 | Avi Kivity | static struct omap_tipb_bridge_s *omap_tipb_bridge_init( |
1222 | 4b3fedf3 | Avi Kivity | MemoryRegion *memory, target_phys_addr_t base, |
1223 | 4b3fedf3 | Avi Kivity | qemu_irq abort_irq, omap_clk clk) |
1224 | c3d2689d | balrog | { |
1225 | c3d2689d | balrog | struct omap_tipb_bridge_s *s = (struct omap_tipb_bridge_s *) |
1226 | 7267c094 | Anthony Liguori | g_malloc0(sizeof(struct omap_tipb_bridge_s)); |
1227 | c3d2689d | balrog | |
1228 | c3d2689d | balrog | s->abort = abort_irq; |
1229 | c3d2689d | balrog | omap_tipb_bridge_reset(s); |
1230 | c3d2689d | balrog | |
1231 | 4b3fedf3 | Avi Kivity | memory_region_init_io(&s->iomem, &omap_tipb_bridge_ops, s, |
1232 | 4b3fedf3 | Avi Kivity | "omap-tipb-bridge", 0x100); |
1233 | 4b3fedf3 | Avi Kivity | memory_region_add_subregion(memory, base, &s->iomem); |
1234 | c3d2689d | balrog | |
1235 | c3d2689d | balrog | return s;
|
1236 | c3d2689d | balrog | } |
1237 | c3d2689d | balrog | |
1238 | c3d2689d | balrog | /* Dummy Traffic Controller's Memory Interface */
|
1239 | e7aa0ae0 | Avi Kivity | static uint64_t omap_tcmi_read(void *opaque, target_phys_addr_t addr, |
1240 | e7aa0ae0 | Avi Kivity | unsigned size)
|
1241 | c3d2689d | balrog | { |
1242 | c3d2689d | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
1243 | c3d2689d | balrog | uint32_t ret; |
1244 | c3d2689d | balrog | |
1245 | e7aa0ae0 | Avi Kivity | if (size != 4) { |
1246 | e7aa0ae0 | Avi Kivity | return omap_badwidth_read32(opaque, addr);
|
1247 | e7aa0ae0 | Avi Kivity | } |
1248 | e7aa0ae0 | Avi Kivity | |
1249 | 8da3ff18 | pbrook | switch (addr) {
|
1250 | d8f699cb | balrog | case 0x00: /* IMIF_PRIO */ |
1251 | d8f699cb | balrog | case 0x04: /* EMIFS_PRIO */ |
1252 | d8f699cb | balrog | case 0x08: /* EMIFF_PRIO */ |
1253 | d8f699cb | balrog | case 0x0c: /* EMIFS_CONFIG */ |
1254 | d8f699cb | balrog | case 0x10: /* EMIFS_CS0_CONFIG */ |
1255 | d8f699cb | balrog | case 0x14: /* EMIFS_CS1_CONFIG */ |
1256 | d8f699cb | balrog | case 0x18: /* EMIFS_CS2_CONFIG */ |
1257 | d8f699cb | balrog | case 0x1c: /* EMIFS_CS3_CONFIG */ |
1258 | d8f699cb | balrog | case 0x24: /* EMIFF_MRS */ |
1259 | d8f699cb | balrog | case 0x28: /* TIMEOUT1 */ |
1260 | d8f699cb | balrog | case 0x2c: /* TIMEOUT2 */ |
1261 | d8f699cb | balrog | case 0x30: /* TIMEOUT3 */ |
1262 | d8f699cb | balrog | case 0x3c: /* EMIFF_SDRAM_CONFIG_2 */ |
1263 | d8f699cb | balrog | case 0x40: /* EMIFS_CFG_DYN_WAIT */ |
1264 | 8da3ff18 | pbrook | return s->tcmi_regs[addr >> 2]; |
1265 | c3d2689d | balrog | |
1266 | d8f699cb | balrog | case 0x20: /* EMIFF_SDRAM_CONFIG */ |
1267 | 8da3ff18 | pbrook | ret = s->tcmi_regs[addr >> 2];
|
1268 | 8da3ff18 | pbrook | s->tcmi_regs[addr >> 2] &= ~1; /* XXX: Clear SLRF on SDRAM access */ |
1269 | c3d2689d | balrog | /* XXX: We can try using the VGA_DIRTY flag for this */
|
1270 | c3d2689d | balrog | return ret;
|
1271 | c3d2689d | balrog | } |
1272 | c3d2689d | balrog | |
1273 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
1274 | c3d2689d | balrog | return 0; |
1275 | c3d2689d | balrog | } |
1276 | c3d2689d | balrog | |
1277 | c227f099 | Anthony Liguori | static void omap_tcmi_write(void *opaque, target_phys_addr_t addr, |
1278 | e7aa0ae0 | Avi Kivity | uint64_t value, unsigned size)
|
1279 | c3d2689d | balrog | { |
1280 | c3d2689d | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
1281 | c3d2689d | balrog | |
1282 | e7aa0ae0 | Avi Kivity | if (size != 4) { |
1283 | e7aa0ae0 | Avi Kivity | return omap_badwidth_write32(opaque, addr, value);
|
1284 | e7aa0ae0 | Avi Kivity | } |
1285 | e7aa0ae0 | Avi Kivity | |
1286 | 8da3ff18 | pbrook | switch (addr) {
|
1287 | d8f699cb | balrog | case 0x00: /* IMIF_PRIO */ |
1288 | d8f699cb | balrog | case 0x04: /* EMIFS_PRIO */ |
1289 | d8f699cb | balrog | case 0x08: /* EMIFF_PRIO */ |
1290 | d8f699cb | balrog | case 0x10: /* EMIFS_CS0_CONFIG */ |
1291 | d8f699cb | balrog | case 0x14: /* EMIFS_CS1_CONFIG */ |
1292 | d8f699cb | balrog | case 0x18: /* EMIFS_CS2_CONFIG */ |
1293 | d8f699cb | balrog | case 0x1c: /* EMIFS_CS3_CONFIG */ |
1294 | d8f699cb | balrog | case 0x20: /* EMIFF_SDRAM_CONFIG */ |
1295 | d8f699cb | balrog | case 0x24: /* EMIFF_MRS */ |
1296 | d8f699cb | balrog | case 0x28: /* TIMEOUT1 */ |
1297 | d8f699cb | balrog | case 0x2c: /* TIMEOUT2 */ |
1298 | d8f699cb | balrog | case 0x30: /* TIMEOUT3 */ |
1299 | d8f699cb | balrog | case 0x3c: /* EMIFF_SDRAM_CONFIG_2 */ |
1300 | d8f699cb | balrog | case 0x40: /* EMIFS_CFG_DYN_WAIT */ |
1301 | 8da3ff18 | pbrook | s->tcmi_regs[addr >> 2] = value;
|
1302 | c3d2689d | balrog | break;
|
1303 | d8f699cb | balrog | case 0x0c: /* EMIFS_CONFIG */ |
1304 | 8da3ff18 | pbrook | s->tcmi_regs[addr >> 2] = (value & 0xf) | (1 << 4); |
1305 | c3d2689d | balrog | break;
|
1306 | c3d2689d | balrog | |
1307 | c3d2689d | balrog | default:
|
1308 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
1309 | c3d2689d | balrog | } |
1310 | c3d2689d | balrog | } |
1311 | c3d2689d | balrog | |
1312 | e7aa0ae0 | Avi Kivity | static const MemoryRegionOps omap_tcmi_ops = { |
1313 | e7aa0ae0 | Avi Kivity | .read = omap_tcmi_read, |
1314 | e7aa0ae0 | Avi Kivity | .write = omap_tcmi_write, |
1315 | e7aa0ae0 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
1316 | c3d2689d | balrog | }; |
1317 | c3d2689d | balrog | |
1318 | c3d2689d | balrog | static void omap_tcmi_reset(struct omap_mpu_state_s *mpu) |
1319 | c3d2689d | balrog | { |
1320 | c3d2689d | balrog | mpu->tcmi_regs[0x00 >> 2] = 0x00000000; |
1321 | c3d2689d | balrog | mpu->tcmi_regs[0x04 >> 2] = 0x00000000; |
1322 | c3d2689d | balrog | mpu->tcmi_regs[0x08 >> 2] = 0x00000000; |
1323 | c3d2689d | balrog | mpu->tcmi_regs[0x0c >> 2] = 0x00000010; |
1324 | c3d2689d | balrog | mpu->tcmi_regs[0x10 >> 2] = 0x0010fffb; |
1325 | c3d2689d | balrog | mpu->tcmi_regs[0x14 >> 2] = 0x0010fffb; |
1326 | c3d2689d | balrog | mpu->tcmi_regs[0x18 >> 2] = 0x0010fffb; |
1327 | c3d2689d | balrog | mpu->tcmi_regs[0x1c >> 2] = 0x0010fffb; |
1328 | c3d2689d | balrog | mpu->tcmi_regs[0x20 >> 2] = 0x00618800; |
1329 | c3d2689d | balrog | mpu->tcmi_regs[0x24 >> 2] = 0x00000037; |
1330 | c3d2689d | balrog | mpu->tcmi_regs[0x28 >> 2] = 0x00000000; |
1331 | c3d2689d | balrog | mpu->tcmi_regs[0x2c >> 2] = 0x00000000; |
1332 | c3d2689d | balrog | mpu->tcmi_regs[0x30 >> 2] = 0x00000000; |
1333 | c3d2689d | balrog | mpu->tcmi_regs[0x3c >> 2] = 0x00000003; |
1334 | c3d2689d | balrog | mpu->tcmi_regs[0x40 >> 2] = 0x00000000; |
1335 | c3d2689d | balrog | } |
1336 | c3d2689d | balrog | |
1337 | e7aa0ae0 | Avi Kivity | static void omap_tcmi_init(MemoryRegion *memory, target_phys_addr_t base, |
1338 | c3d2689d | balrog | struct omap_mpu_state_s *mpu)
|
1339 | c3d2689d | balrog | { |
1340 | e7aa0ae0 | Avi Kivity | memory_region_init_io(&mpu->tcmi_iomem, &omap_tcmi_ops, mpu, |
1341 | e7aa0ae0 | Avi Kivity | "omap-tcmi", 0x100); |
1342 | e7aa0ae0 | Avi Kivity | memory_region_add_subregion(memory, base, &mpu->tcmi_iomem); |
1343 | c3d2689d | balrog | omap_tcmi_reset(mpu); |
1344 | c3d2689d | balrog | } |
1345 | c3d2689d | balrog | |
1346 | c3d2689d | balrog | /* Digital phase-locked loops control */
|
1347 | e7aa0ae0 | Avi Kivity | static uint64_t omap_dpll_read(void *opaque, target_phys_addr_t addr, |
1348 | e7aa0ae0 | Avi Kivity | unsigned size)
|
1349 | c3d2689d | balrog | { |
1350 | c3d2689d | balrog | struct dpll_ctl_s *s = (struct dpll_ctl_s *) opaque; |
1351 | c3d2689d | balrog | |
1352 | e7aa0ae0 | Avi Kivity | if (size != 2) { |
1353 | e7aa0ae0 | Avi Kivity | return omap_badwidth_read16(opaque, addr);
|
1354 | e7aa0ae0 | Avi Kivity | } |
1355 | e7aa0ae0 | Avi Kivity | |
1356 | 8da3ff18 | pbrook | if (addr == 0x00) /* CTL_REG */ |
1357 | c3d2689d | balrog | return s->mode;
|
1358 | c3d2689d | balrog | |
1359 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
1360 | c3d2689d | balrog | return 0; |
1361 | c3d2689d | balrog | } |
1362 | c3d2689d | balrog | |
1363 | c227f099 | Anthony Liguori | static void omap_dpll_write(void *opaque, target_phys_addr_t addr, |
1364 | e7aa0ae0 | Avi Kivity | uint64_t value, unsigned size)
|
1365 | c3d2689d | balrog | { |
1366 | c3d2689d | balrog | struct dpll_ctl_s *s = (struct dpll_ctl_s *) opaque; |
1367 | c3d2689d | balrog | uint16_t diff; |
1368 | c3d2689d | balrog | static const int bypass_div[4] = { 1, 2, 4, 4 }; |
1369 | c3d2689d | balrog | int div, mult;
|
1370 | c3d2689d | balrog | |
1371 | e7aa0ae0 | Avi Kivity | if (size != 2) { |
1372 | e7aa0ae0 | Avi Kivity | return omap_badwidth_write16(opaque, addr, value);
|
1373 | e7aa0ae0 | Avi Kivity | } |
1374 | e7aa0ae0 | Avi Kivity | |
1375 | 8da3ff18 | pbrook | if (addr == 0x00) { /* CTL_REG */ |
1376 | c3d2689d | balrog | /* See omap_ulpd_pm_write() too */
|
1377 | c3d2689d | balrog | diff = s->mode & value; |
1378 | c3d2689d | balrog | s->mode = value & 0x2fff;
|
1379 | c3d2689d | balrog | if (diff & (0x3ff << 2)) { |
1380 | c3d2689d | balrog | if (value & (1 << 4)) { /* PLL_ENABLE */ |
1381 | c3d2689d | balrog | div = ((value >> 5) & 3) + 1; /* PLL_DIV */ |
1382 | c3d2689d | balrog | mult = MIN((value >> 7) & 0x1f, 1); /* PLL_MULT */ |
1383 | c3d2689d | balrog | } else {
|
1384 | c3d2689d | balrog | div = bypass_div[((value >> 2) & 3)]; /* BYPASS_DIV */ |
1385 | c3d2689d | balrog | mult = 1;
|
1386 | c3d2689d | balrog | } |
1387 | c3d2689d | balrog | omap_clk_setrate(s->dpll, div, mult); |
1388 | c3d2689d | balrog | } |
1389 | c3d2689d | balrog | |
1390 | c3d2689d | balrog | /* Enter the desired mode. */
|
1391 | c3d2689d | balrog | s->mode = (s->mode & 0xfffe) | ((s->mode >> 4) & 1); |
1392 | c3d2689d | balrog | |
1393 | c3d2689d | balrog | /* Act as if the lock is restored. */
|
1394 | c3d2689d | balrog | s->mode |= 2;
|
1395 | c3d2689d | balrog | } else {
|
1396 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
1397 | c3d2689d | balrog | } |
1398 | c3d2689d | balrog | } |
1399 | c3d2689d | balrog | |
1400 | e7aa0ae0 | Avi Kivity | static const MemoryRegionOps omap_dpll_ops = { |
1401 | e7aa0ae0 | Avi Kivity | .read = omap_dpll_read, |
1402 | e7aa0ae0 | Avi Kivity | .write = omap_dpll_write, |
1403 | e7aa0ae0 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
1404 | c3d2689d | balrog | }; |
1405 | c3d2689d | balrog | |
1406 | c3d2689d | balrog | static void omap_dpll_reset(struct dpll_ctl_s *s) |
1407 | c3d2689d | balrog | { |
1408 | c3d2689d | balrog | s->mode = 0x2002;
|
1409 | c3d2689d | balrog | omap_clk_setrate(s->dpll, 1, 1); |
1410 | c3d2689d | balrog | } |
1411 | c3d2689d | balrog | |
1412 | e7aa0ae0 | Avi Kivity | static void omap_dpll_init(MemoryRegion *memory, struct dpll_ctl_s *s, |
1413 | e7aa0ae0 | Avi Kivity | target_phys_addr_t base, omap_clk clk) |
1414 | c3d2689d | balrog | { |
1415 | e7aa0ae0 | Avi Kivity | memory_region_init_io(&s->iomem, &omap_dpll_ops, s, "omap-dpll", 0x100); |
1416 | c3d2689d | balrog | |
1417 | c3d2689d | balrog | s->dpll = clk; |
1418 | c3d2689d | balrog | omap_dpll_reset(s); |
1419 | c3d2689d | balrog | |
1420 | e7aa0ae0 | Avi Kivity | memory_region_add_subregion(memory, base, &s->iomem); |
1421 | c3d2689d | balrog | } |
1422 | c3d2689d | balrog | |
1423 | c3d2689d | balrog | /* MPU Clock/Reset/Power Mode Control */
|
1424 | e7aa0ae0 | Avi Kivity | static uint64_t omap_clkm_read(void *opaque, target_phys_addr_t addr, |
1425 | e7aa0ae0 | Avi Kivity | unsigned size)
|
1426 | c3d2689d | balrog | { |
1427 | c3d2689d | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
1428 | c3d2689d | balrog | |
1429 | e7aa0ae0 | Avi Kivity | if (size != 2) { |
1430 | e7aa0ae0 | Avi Kivity | return omap_badwidth_read16(opaque, addr);
|
1431 | e7aa0ae0 | Avi Kivity | } |
1432 | e7aa0ae0 | Avi Kivity | |
1433 | 8da3ff18 | pbrook | switch (addr) {
|
1434 | c3d2689d | balrog | case 0x00: /* ARM_CKCTL */ |
1435 | c3d2689d | balrog | return s->clkm.arm_ckctl;
|
1436 | c3d2689d | balrog | |
1437 | c3d2689d | balrog | case 0x04: /* ARM_IDLECT1 */ |
1438 | c3d2689d | balrog | return s->clkm.arm_idlect1;
|
1439 | c3d2689d | balrog | |
1440 | c3d2689d | balrog | case 0x08: /* ARM_IDLECT2 */ |
1441 | c3d2689d | balrog | return s->clkm.arm_idlect2;
|
1442 | c3d2689d | balrog | |
1443 | c3d2689d | balrog | case 0x0c: /* ARM_EWUPCT */ |
1444 | c3d2689d | balrog | return s->clkm.arm_ewupct;
|
1445 | c3d2689d | balrog | |
1446 | c3d2689d | balrog | case 0x10: /* ARM_RSTCT1 */ |
1447 | c3d2689d | balrog | return s->clkm.arm_rstct1;
|
1448 | c3d2689d | balrog | |
1449 | c3d2689d | balrog | case 0x14: /* ARM_RSTCT2 */ |
1450 | c3d2689d | balrog | return s->clkm.arm_rstct2;
|
1451 | c3d2689d | balrog | |
1452 | c3d2689d | balrog | case 0x18: /* ARM_SYSST */ |
1453 | d8f699cb | balrog | return (s->clkm.clocking_scheme << 11) | s->clkm.cold_start; |
1454 | c3d2689d | balrog | |
1455 | c3d2689d | balrog | case 0x1c: /* ARM_CKOUT1 */ |
1456 | c3d2689d | balrog | return s->clkm.arm_ckout1;
|
1457 | c3d2689d | balrog | |
1458 | c3d2689d | balrog | case 0x20: /* ARM_CKOUT2 */ |
1459 | c3d2689d | balrog | break;
|
1460 | c3d2689d | balrog | } |
1461 | c3d2689d | balrog | |
1462 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
1463 | c3d2689d | balrog | return 0; |
1464 | c3d2689d | balrog | } |
1465 | c3d2689d | balrog | |
1466 | c3d2689d | balrog | static inline void omap_clkm_ckctl_update(struct omap_mpu_state_s *s, |
1467 | c3d2689d | balrog | uint16_t diff, uint16_t value) |
1468 | c3d2689d | balrog | { |
1469 | c3d2689d | balrog | omap_clk clk; |
1470 | c3d2689d | balrog | |
1471 | c3d2689d | balrog | if (diff & (1 << 14)) { /* ARM_INTHCK_SEL */ |
1472 | c3d2689d | balrog | if (value & (1 << 14)) |
1473 | c3d2689d | balrog | /* Reserved */;
|
1474 | c3d2689d | balrog | else {
|
1475 | c3d2689d | balrog | clk = omap_findclk(s, "arminth_ck");
|
1476 | c3d2689d | balrog | omap_clk_reparent(clk, omap_findclk(s, "tc_ck"));
|
1477 | c3d2689d | balrog | } |
1478 | c3d2689d | balrog | } |
1479 | c3d2689d | balrog | if (diff & (1 << 12)) { /* ARM_TIMXO */ |
1480 | c3d2689d | balrog | clk = omap_findclk(s, "armtim_ck");
|
1481 | c3d2689d | balrog | if (value & (1 << 12)) |
1482 | c3d2689d | balrog | omap_clk_reparent(clk, omap_findclk(s, "clkin"));
|
1483 | c3d2689d | balrog | else
|
1484 | c3d2689d | balrog | omap_clk_reparent(clk, omap_findclk(s, "ck_gen1"));
|
1485 | c3d2689d | balrog | } |
1486 | c3d2689d | balrog | /* XXX: en_dspck */
|
1487 | c3d2689d | balrog | if (diff & (3 << 10)) { /* DSPMMUDIV */ |
1488 | c3d2689d | balrog | clk = omap_findclk(s, "dspmmu_ck");
|
1489 | c3d2689d | balrog | omap_clk_setrate(clk, 1 << ((value >> 10) & 3), 1); |
1490 | c3d2689d | balrog | } |
1491 | c3d2689d | balrog | if (diff & (3 << 8)) { /* TCDIV */ |
1492 | c3d2689d | balrog | clk = omap_findclk(s, "tc_ck");
|
1493 | c3d2689d | balrog | omap_clk_setrate(clk, 1 << ((value >> 8) & 3), 1); |
1494 | c3d2689d | balrog | } |
1495 | c3d2689d | balrog | if (diff & (3 << 6)) { /* DSPDIV */ |
1496 | c3d2689d | balrog | clk = omap_findclk(s, "dsp_ck");
|
1497 | c3d2689d | balrog | omap_clk_setrate(clk, 1 << ((value >> 6) & 3), 1); |
1498 | c3d2689d | balrog | } |
1499 | c3d2689d | balrog | if (diff & (3 << 4)) { /* ARMDIV */ |
1500 | c3d2689d | balrog | clk = omap_findclk(s, "arm_ck");
|
1501 | c3d2689d | balrog | omap_clk_setrate(clk, 1 << ((value >> 4) & 3), 1); |
1502 | c3d2689d | balrog | } |
1503 | c3d2689d | balrog | if (diff & (3 << 2)) { /* LCDDIV */ |
1504 | c3d2689d | balrog | clk = omap_findclk(s, "lcd_ck");
|
1505 | c3d2689d | balrog | omap_clk_setrate(clk, 1 << ((value >> 2) & 3), 1); |
1506 | c3d2689d | balrog | } |
1507 | c3d2689d | balrog | if (diff & (3 << 0)) { /* PERDIV */ |
1508 | c3d2689d | balrog | clk = omap_findclk(s, "armper_ck");
|
1509 | c3d2689d | balrog | omap_clk_setrate(clk, 1 << ((value >> 0) & 3), 1); |
1510 | c3d2689d | balrog | } |
1511 | c3d2689d | balrog | } |
1512 | c3d2689d | balrog | |
1513 | c3d2689d | balrog | static inline void omap_clkm_idlect1_update(struct omap_mpu_state_s *s, |
1514 | c3d2689d | balrog | uint16_t diff, uint16_t value) |
1515 | c3d2689d | balrog | { |
1516 | c3d2689d | balrog | omap_clk clk; |
1517 | c3d2689d | balrog | |
1518 | c3d2689d | balrog | if (value & (1 << 11)) /* SETARM_IDLE */ |
1519 | c3d2689d | balrog | cpu_interrupt(s->env, CPU_INTERRUPT_HALT); |
1520 | c3d2689d | balrog | if (!(value & (1 << 10))) /* WKUP_MODE */ |
1521 | c3d2689d | balrog | qemu_system_shutdown_request(); /* XXX: disable wakeup from IRQ */
|
1522 | c3d2689d | balrog | |
1523 | c3d2689d | balrog | #define SET_CANIDLE(clock, bit) \
|
1524 | c3d2689d | balrog | if (diff & (1 << bit)) { \ |
1525 | c3d2689d | balrog | clk = omap_findclk(s, clock); \ |
1526 | c3d2689d | balrog | omap_clk_canidle(clk, (value >> bit) & 1); \
|
1527 | c3d2689d | balrog | } |
1528 | c3d2689d | balrog | SET_CANIDLE("mpuwd_ck", 0) /* IDLWDT_ARM */ |
1529 | c3d2689d | balrog | SET_CANIDLE("armxor_ck", 1) /* IDLXORP_ARM */ |
1530 | c3d2689d | balrog | SET_CANIDLE("mpuper_ck", 2) /* IDLPER_ARM */ |
1531 | c3d2689d | balrog | SET_CANIDLE("lcd_ck", 3) /* IDLLCD_ARM */ |
1532 | c3d2689d | balrog | SET_CANIDLE("lb_ck", 4) /* IDLLB_ARM */ |
1533 | c3d2689d | balrog | SET_CANIDLE("hsab_ck", 5) /* IDLHSAB_ARM */ |
1534 | c3d2689d | balrog | SET_CANIDLE("tipb_ck", 6) /* IDLIF_ARM */ |
1535 | c3d2689d | balrog | SET_CANIDLE("dma_ck", 6) /* IDLIF_ARM */ |
1536 | c3d2689d | balrog | SET_CANIDLE("tc_ck", 6) /* IDLIF_ARM */ |
1537 | c3d2689d | balrog | SET_CANIDLE("dpll1", 7) /* IDLDPLL_ARM */ |
1538 | c3d2689d | balrog | SET_CANIDLE("dpll2", 7) /* IDLDPLL_ARM */ |
1539 | c3d2689d | balrog | SET_CANIDLE("dpll3", 7) /* IDLDPLL_ARM */ |
1540 | c3d2689d | balrog | SET_CANIDLE("mpui_ck", 8) /* IDLAPI_ARM */ |
1541 | c3d2689d | balrog | SET_CANIDLE("armtim_ck", 9) /* IDLTIM_ARM */ |
1542 | c3d2689d | balrog | } |
1543 | c3d2689d | balrog | |
1544 | c3d2689d | balrog | static inline void omap_clkm_idlect2_update(struct omap_mpu_state_s *s, |
1545 | c3d2689d | balrog | uint16_t diff, uint16_t value) |
1546 | c3d2689d | balrog | { |
1547 | c3d2689d | balrog | omap_clk clk; |
1548 | c3d2689d | balrog | |
1549 | c3d2689d | balrog | #define SET_ONOFF(clock, bit) \
|
1550 | c3d2689d | balrog | if (diff & (1 << bit)) { \ |
1551 | c3d2689d | balrog | clk = omap_findclk(s, clock); \ |
1552 | c3d2689d | balrog | omap_clk_onoff(clk, (value >> bit) & 1); \
|
1553 | c3d2689d | balrog | } |
1554 | c3d2689d | balrog | SET_ONOFF("mpuwd_ck", 0) /* EN_WDTCK */ |
1555 | c3d2689d | balrog | SET_ONOFF("armxor_ck", 1) /* EN_XORPCK */ |
1556 | c3d2689d | balrog | SET_ONOFF("mpuper_ck", 2) /* EN_PERCK */ |
1557 | c3d2689d | balrog | SET_ONOFF("lcd_ck", 3) /* EN_LCDCK */ |
1558 | c3d2689d | balrog | SET_ONOFF("lb_ck", 4) /* EN_LBCK */ |
1559 | c3d2689d | balrog | SET_ONOFF("hsab_ck", 5) /* EN_HSABCK */ |
1560 | c3d2689d | balrog | SET_ONOFF("mpui_ck", 6) /* EN_APICK */ |
1561 | c3d2689d | balrog | SET_ONOFF("armtim_ck", 7) /* EN_TIMCK */ |
1562 | c3d2689d | balrog | SET_CANIDLE("dma_ck", 8) /* DMACK_REQ */ |
1563 | c3d2689d | balrog | SET_ONOFF("arm_gpio_ck", 9) /* EN_GPIOCK */ |
1564 | c3d2689d | balrog | SET_ONOFF("lbfree_ck", 10) /* EN_LBFREECK */ |
1565 | c3d2689d | balrog | } |
1566 | c3d2689d | balrog | |
1567 | c3d2689d | balrog | static inline void omap_clkm_ckout1_update(struct omap_mpu_state_s *s, |
1568 | c3d2689d | balrog | uint16_t diff, uint16_t value) |
1569 | c3d2689d | balrog | { |
1570 | c3d2689d | balrog | omap_clk clk; |
1571 | c3d2689d | balrog | |
1572 | c3d2689d | balrog | if (diff & (3 << 4)) { /* TCLKOUT */ |
1573 | c3d2689d | balrog | clk = omap_findclk(s, "tclk_out");
|
1574 | c3d2689d | balrog | switch ((value >> 4) & 3) { |
1575 | c3d2689d | balrog | case 1: |
1576 | c3d2689d | balrog | omap_clk_reparent(clk, omap_findclk(s, "ck_gen3"));
|
1577 | c3d2689d | balrog | omap_clk_onoff(clk, 1);
|
1578 | c3d2689d | balrog | break;
|
1579 | c3d2689d | balrog | case 2: |
1580 | c3d2689d | balrog | omap_clk_reparent(clk, omap_findclk(s, "tc_ck"));
|
1581 | c3d2689d | balrog | omap_clk_onoff(clk, 1);
|
1582 | c3d2689d | balrog | break;
|
1583 | c3d2689d | balrog | default:
|
1584 | c3d2689d | balrog | omap_clk_onoff(clk, 0);
|
1585 | c3d2689d | balrog | } |
1586 | c3d2689d | balrog | } |
1587 | c3d2689d | balrog | if (diff & (3 << 2)) { /* DCLKOUT */ |
1588 | c3d2689d | balrog | clk = omap_findclk(s, "dclk_out");
|
1589 | c3d2689d | balrog | switch ((value >> 2) & 3) { |
1590 | c3d2689d | balrog | case 0: |
1591 | c3d2689d | balrog | omap_clk_reparent(clk, omap_findclk(s, "dspmmu_ck"));
|
1592 | c3d2689d | balrog | break;
|
1593 | c3d2689d | balrog | case 1: |
1594 | c3d2689d | balrog | omap_clk_reparent(clk, omap_findclk(s, "ck_gen2"));
|
1595 | c3d2689d | balrog | break;
|
1596 | c3d2689d | balrog | case 2: |
1597 | c3d2689d | balrog | omap_clk_reparent(clk, omap_findclk(s, "dsp_ck"));
|
1598 | c3d2689d | balrog | break;
|
1599 | c3d2689d | balrog | case 3: |
1600 | c3d2689d | balrog | omap_clk_reparent(clk, omap_findclk(s, "ck_ref14"));
|
1601 | c3d2689d | balrog | break;
|
1602 | c3d2689d | balrog | } |
1603 | c3d2689d | balrog | } |
1604 | c3d2689d | balrog | if (diff & (3 << 0)) { /* ACLKOUT */ |
1605 | c3d2689d | balrog | clk = omap_findclk(s, "aclk_out");
|
1606 | c3d2689d | balrog | switch ((value >> 0) & 3) { |
1607 | c3d2689d | balrog | case 1: |
1608 | c3d2689d | balrog | omap_clk_reparent(clk, omap_findclk(s, "ck_gen1"));
|
1609 | c3d2689d | balrog | omap_clk_onoff(clk, 1);
|
1610 | c3d2689d | balrog | break;
|
1611 | c3d2689d | balrog | case 2: |
1612 | c3d2689d | balrog | omap_clk_reparent(clk, omap_findclk(s, "arm_ck"));
|
1613 | c3d2689d | balrog | omap_clk_onoff(clk, 1);
|
1614 | c3d2689d | balrog | break;
|
1615 | c3d2689d | balrog | case 3: |
1616 | c3d2689d | balrog | omap_clk_reparent(clk, omap_findclk(s, "ck_ref14"));
|
1617 | c3d2689d | balrog | omap_clk_onoff(clk, 1);
|
1618 | c3d2689d | balrog | break;
|
1619 | c3d2689d | balrog | default:
|
1620 | c3d2689d | balrog | omap_clk_onoff(clk, 0);
|
1621 | c3d2689d | balrog | } |
1622 | c3d2689d | balrog | } |
1623 | c3d2689d | balrog | } |
1624 | c3d2689d | balrog | |
1625 | c227f099 | Anthony Liguori | static void omap_clkm_write(void *opaque, target_phys_addr_t addr, |
1626 | e7aa0ae0 | Avi Kivity | uint64_t value, unsigned size)
|
1627 | c3d2689d | balrog | { |
1628 | c3d2689d | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
1629 | c3d2689d | balrog | uint16_t diff; |
1630 | c3d2689d | balrog | omap_clk clk; |
1631 | c3d2689d | balrog | static const char *clkschemename[8] = { |
1632 | c3d2689d | balrog | "fully synchronous", "fully asynchronous", "synchronous scalable", |
1633 | c3d2689d | balrog | "mix mode 1", "mix mode 2", "bypass mode", "mix mode 3", "mix mode 4", |
1634 | c3d2689d | balrog | }; |
1635 | c3d2689d | balrog | |
1636 | e7aa0ae0 | Avi Kivity | if (size != 2) { |
1637 | e7aa0ae0 | Avi Kivity | return omap_badwidth_write16(opaque, addr, value);
|
1638 | e7aa0ae0 | Avi Kivity | } |
1639 | e7aa0ae0 | Avi Kivity | |
1640 | 8da3ff18 | pbrook | switch (addr) {
|
1641 | c3d2689d | balrog | case 0x00: /* ARM_CKCTL */ |
1642 | c3d2689d | balrog | diff = s->clkm.arm_ckctl ^ value; |
1643 | c3d2689d | balrog | s->clkm.arm_ckctl = value & 0x7fff;
|
1644 | c3d2689d | balrog | omap_clkm_ckctl_update(s, diff, value); |
1645 | c3d2689d | balrog | return;
|
1646 | c3d2689d | balrog | |
1647 | c3d2689d | balrog | case 0x04: /* ARM_IDLECT1 */ |
1648 | c3d2689d | balrog | diff = s->clkm.arm_idlect1 ^ value; |
1649 | c3d2689d | balrog | s->clkm.arm_idlect1 = value & 0x0fff;
|
1650 | c3d2689d | balrog | omap_clkm_idlect1_update(s, diff, value); |
1651 | c3d2689d | balrog | return;
|
1652 | c3d2689d | balrog | |
1653 | c3d2689d | balrog | case 0x08: /* ARM_IDLECT2 */ |
1654 | c3d2689d | balrog | diff = s->clkm.arm_idlect2 ^ value; |
1655 | c3d2689d | balrog | s->clkm.arm_idlect2 = value & 0x07ff;
|
1656 | c3d2689d | balrog | omap_clkm_idlect2_update(s, diff, value); |
1657 | c3d2689d | balrog | return;
|
1658 | c3d2689d | balrog | |
1659 | c3d2689d | balrog | case 0x0c: /* ARM_EWUPCT */ |
1660 | c3d2689d | balrog | s->clkm.arm_ewupct = value & 0x003f;
|
1661 | c3d2689d | balrog | return;
|
1662 | c3d2689d | balrog | |
1663 | c3d2689d | balrog | case 0x10: /* ARM_RSTCT1 */ |
1664 | c3d2689d | balrog | diff = s->clkm.arm_rstct1 ^ value; |
1665 | c3d2689d | balrog | s->clkm.arm_rstct1 = value & 0x0007;
|
1666 | c3d2689d | balrog | if (value & 9) { |
1667 | c3d2689d | balrog | qemu_system_reset_request(); |
1668 | c3d2689d | balrog | s->clkm.cold_start = 0xa;
|
1669 | c3d2689d | balrog | } |
1670 | c3d2689d | balrog | if (diff & ~value & 4) { /* DSP_RST */ |
1671 | c3d2689d | balrog | omap_mpui_reset(s); |
1672 | c3d2689d | balrog | omap_tipb_bridge_reset(s->private_tipb); |
1673 | c3d2689d | balrog | omap_tipb_bridge_reset(s->public_tipb); |
1674 | c3d2689d | balrog | } |
1675 | c3d2689d | balrog | if (diff & 2) { /* DSP_EN */ |
1676 | c3d2689d | balrog | clk = omap_findclk(s, "dsp_ck");
|
1677 | c3d2689d | balrog | omap_clk_canidle(clk, (~value >> 1) & 1); |
1678 | c3d2689d | balrog | } |
1679 | c3d2689d | balrog | return;
|
1680 | c3d2689d | balrog | |
1681 | c3d2689d | balrog | case 0x14: /* ARM_RSTCT2 */ |
1682 | c3d2689d | balrog | s->clkm.arm_rstct2 = value & 0x0001;
|
1683 | c3d2689d | balrog | return;
|
1684 | c3d2689d | balrog | |
1685 | c3d2689d | balrog | case 0x18: /* ARM_SYSST */ |
1686 | c3d2689d | balrog | if ((s->clkm.clocking_scheme ^ (value >> 11)) & 7) { |
1687 | c3d2689d | balrog | s->clkm.clocking_scheme = (value >> 11) & 7; |
1688 | c3d2689d | balrog | printf("%s: clocking scheme set to %s\n", __FUNCTION__,
|
1689 | c3d2689d | balrog | clkschemename[s->clkm.clocking_scheme]); |
1690 | c3d2689d | balrog | } |
1691 | c3d2689d | balrog | s->clkm.cold_start &= value & 0x3f;
|
1692 | c3d2689d | balrog | return;
|
1693 | c3d2689d | balrog | |
1694 | c3d2689d | balrog | case 0x1c: /* ARM_CKOUT1 */ |
1695 | c3d2689d | balrog | diff = s->clkm.arm_ckout1 ^ value; |
1696 | c3d2689d | balrog | s->clkm.arm_ckout1 = value & 0x003f;
|
1697 | c3d2689d | balrog | omap_clkm_ckout1_update(s, diff, value); |
1698 | c3d2689d | balrog | return;
|
1699 | c3d2689d | balrog | |
1700 | c3d2689d | balrog | case 0x20: /* ARM_CKOUT2 */ |
1701 | c3d2689d | balrog | default:
|
1702 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
1703 | c3d2689d | balrog | } |
1704 | c3d2689d | balrog | } |
1705 | c3d2689d | balrog | |
1706 | e7aa0ae0 | Avi Kivity | static const MemoryRegionOps omap_clkm_ops = { |
1707 | e7aa0ae0 | Avi Kivity | .read = omap_clkm_read, |
1708 | e7aa0ae0 | Avi Kivity | .write = omap_clkm_write, |
1709 | e7aa0ae0 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
1710 | c3d2689d | balrog | }; |
1711 | c3d2689d | balrog | |
1712 | e7aa0ae0 | Avi Kivity | static uint64_t omap_clkdsp_read(void *opaque, target_phys_addr_t addr, |
1713 | e7aa0ae0 | Avi Kivity | unsigned size)
|
1714 | c3d2689d | balrog | { |
1715 | c3d2689d | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
1716 | c3d2689d | balrog | |
1717 | e7aa0ae0 | Avi Kivity | if (size != 2) { |
1718 | e7aa0ae0 | Avi Kivity | return omap_badwidth_read16(opaque, addr);
|
1719 | e7aa0ae0 | Avi Kivity | } |
1720 | e7aa0ae0 | Avi Kivity | |
1721 | 8da3ff18 | pbrook | switch (addr) {
|
1722 | c3d2689d | balrog | case 0x04: /* DSP_IDLECT1 */ |
1723 | c3d2689d | balrog | return s->clkm.dsp_idlect1;
|
1724 | c3d2689d | balrog | |
1725 | c3d2689d | balrog | case 0x08: /* DSP_IDLECT2 */ |
1726 | c3d2689d | balrog | return s->clkm.dsp_idlect2;
|
1727 | c3d2689d | balrog | |
1728 | c3d2689d | balrog | case 0x14: /* DSP_RSTCT2 */ |
1729 | c3d2689d | balrog | return s->clkm.dsp_rstct2;
|
1730 | c3d2689d | balrog | |
1731 | c3d2689d | balrog | case 0x18: /* DSP_SYSST */ |
1732 | d8f699cb | balrog | return (s->clkm.clocking_scheme << 11) | s->clkm.cold_start | |
1733 | c3d2689d | balrog | (s->env->halted << 6); /* Quite useless... */ |
1734 | c3d2689d | balrog | } |
1735 | c3d2689d | balrog | |
1736 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
1737 | c3d2689d | balrog | return 0; |
1738 | c3d2689d | balrog | } |
1739 | c3d2689d | balrog | |
1740 | c3d2689d | balrog | static inline void omap_clkdsp_idlect1_update(struct omap_mpu_state_s *s, |
1741 | c3d2689d | balrog | uint16_t diff, uint16_t value) |
1742 | c3d2689d | balrog | { |
1743 | c3d2689d | balrog | omap_clk clk; |
1744 | c3d2689d | balrog | |
1745 | c3d2689d | balrog | SET_CANIDLE("dspxor_ck", 1); /* IDLXORP_DSP */ |
1746 | c3d2689d | balrog | } |
1747 | c3d2689d | balrog | |
1748 | c3d2689d | balrog | static inline void omap_clkdsp_idlect2_update(struct omap_mpu_state_s *s, |
1749 | c3d2689d | balrog | uint16_t diff, uint16_t value) |
1750 | c3d2689d | balrog | { |
1751 | c3d2689d | balrog | omap_clk clk; |
1752 | c3d2689d | balrog | |
1753 | c3d2689d | balrog | SET_ONOFF("dspxor_ck", 1); /* EN_XORPCK */ |
1754 | c3d2689d | balrog | } |
1755 | c3d2689d | balrog | |
1756 | c227f099 | Anthony Liguori | static void omap_clkdsp_write(void *opaque, target_phys_addr_t addr, |
1757 | e7aa0ae0 | Avi Kivity | uint64_t value, unsigned size)
|
1758 | c3d2689d | balrog | { |
1759 | c3d2689d | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
1760 | c3d2689d | balrog | uint16_t diff; |
1761 | c3d2689d | balrog | |
1762 | e7aa0ae0 | Avi Kivity | if (size != 2) { |
1763 | e7aa0ae0 | Avi Kivity | return omap_badwidth_write16(opaque, addr, value);
|
1764 | e7aa0ae0 | Avi Kivity | } |
1765 | e7aa0ae0 | Avi Kivity | |
1766 | 8da3ff18 | pbrook | switch (addr) {
|
1767 | c3d2689d | balrog | case 0x04: /* DSP_IDLECT1 */ |
1768 | c3d2689d | balrog | diff = s->clkm.dsp_idlect1 ^ value; |
1769 | c3d2689d | balrog | s->clkm.dsp_idlect1 = value & 0x01f7;
|
1770 | c3d2689d | balrog | omap_clkdsp_idlect1_update(s, diff, value); |
1771 | c3d2689d | balrog | break;
|
1772 | c3d2689d | balrog | |
1773 | c3d2689d | balrog | case 0x08: /* DSP_IDLECT2 */ |
1774 | c3d2689d | balrog | s->clkm.dsp_idlect2 = value & 0x0037;
|
1775 | c3d2689d | balrog | diff = s->clkm.dsp_idlect1 ^ value; |
1776 | c3d2689d | balrog | omap_clkdsp_idlect2_update(s, diff, value); |
1777 | c3d2689d | balrog | break;
|
1778 | c3d2689d | balrog | |
1779 | c3d2689d | balrog | case 0x14: /* DSP_RSTCT2 */ |
1780 | c3d2689d | balrog | s->clkm.dsp_rstct2 = value & 0x0001;
|
1781 | c3d2689d | balrog | break;
|
1782 | c3d2689d | balrog | |
1783 | c3d2689d | balrog | case 0x18: /* DSP_SYSST */ |
1784 | c3d2689d | balrog | s->clkm.cold_start &= value & 0x3f;
|
1785 | c3d2689d | balrog | break;
|
1786 | c3d2689d | balrog | |
1787 | c3d2689d | balrog | default:
|
1788 | c3d2689d | balrog | OMAP_BAD_REG(addr); |
1789 | c3d2689d | balrog | } |
1790 | c3d2689d | balrog | } |
1791 | c3d2689d | balrog | |
1792 | e7aa0ae0 | Avi Kivity | static const MemoryRegionOps omap_clkdsp_ops = { |
1793 | e7aa0ae0 | Avi Kivity | .read = omap_clkdsp_read, |
1794 | e7aa0ae0 | Avi Kivity | .write = omap_clkdsp_write, |
1795 | e7aa0ae0 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
1796 | c3d2689d | balrog | }; |
1797 | c3d2689d | balrog | |
1798 | c3d2689d | balrog | static void omap_clkm_reset(struct omap_mpu_state_s *s) |
1799 | c3d2689d | balrog | { |
1800 | c3d2689d | balrog | if (s->wdt && s->wdt->reset)
|
1801 | c3d2689d | balrog | s->clkm.cold_start = 0x6;
|
1802 | c3d2689d | balrog | s->clkm.clocking_scheme = 0;
|
1803 | c3d2689d | balrog | omap_clkm_ckctl_update(s, ~0, 0x3000); |
1804 | c3d2689d | balrog | s->clkm.arm_ckctl = 0x3000;
|
1805 | d8f699cb | balrog | omap_clkm_idlect1_update(s, s->clkm.arm_idlect1 ^ 0x0400, 0x0400); |
1806 | c3d2689d | balrog | s->clkm.arm_idlect1 = 0x0400;
|
1807 | d8f699cb | balrog | omap_clkm_idlect2_update(s, s->clkm.arm_idlect2 ^ 0x0100, 0x0100); |
1808 | c3d2689d | balrog | s->clkm.arm_idlect2 = 0x0100;
|
1809 | c3d2689d | balrog | s->clkm.arm_ewupct = 0x003f;
|
1810 | c3d2689d | balrog | s->clkm.arm_rstct1 = 0x0000;
|
1811 | c3d2689d | balrog | s->clkm.arm_rstct2 = 0x0000;
|
1812 | c3d2689d | balrog | s->clkm.arm_ckout1 = 0x0015;
|
1813 | c3d2689d | balrog | s->clkm.dpll1_mode = 0x2002;
|
1814 | c3d2689d | balrog | omap_clkdsp_idlect1_update(s, s->clkm.dsp_idlect1 ^ 0x0040, 0x0040); |
1815 | c3d2689d | balrog | s->clkm.dsp_idlect1 = 0x0040;
|
1816 | c3d2689d | balrog | omap_clkdsp_idlect2_update(s, ~0, 0x0000); |
1817 | c3d2689d | balrog | s->clkm.dsp_idlect2 = 0x0000;
|
1818 | c3d2689d | balrog | s->clkm.dsp_rstct2 = 0x0000;
|
1819 | c3d2689d | balrog | } |
1820 | c3d2689d | balrog | |
1821 | e7aa0ae0 | Avi Kivity | static void omap_clkm_init(MemoryRegion *memory, target_phys_addr_t mpu_base, |
1822 | c227f099 | Anthony Liguori | target_phys_addr_t dsp_base, struct omap_mpu_state_s *s)
|
1823 | c3d2689d | balrog | { |
1824 | e7aa0ae0 | Avi Kivity | memory_region_init_io(&s->clkm_iomem, &omap_clkm_ops, s, |
1825 | e7aa0ae0 | Avi Kivity | "omap-clkm", 0x100); |
1826 | e7aa0ae0 | Avi Kivity | memory_region_init_io(&s->clkdsp_iomem, &omap_clkdsp_ops, s, |
1827 | e7aa0ae0 | Avi Kivity | "omap-clkdsp", 0x1000); |
1828 | c3d2689d | balrog | |
1829 | d8f699cb | balrog | s->clkm.arm_idlect1 = 0x03ff;
|
1830 | d8f699cb | balrog | s->clkm.arm_idlect2 = 0x0100;
|
1831 | d8f699cb | balrog | s->clkm.dsp_idlect1 = 0x0002;
|
1832 | c3d2689d | balrog | omap_clkm_reset(s); |
1833 | d8f699cb | balrog | s->clkm.cold_start = 0x3a;
|
1834 | c3d2689d | balrog | |
1835 | e7aa0ae0 | Avi Kivity | memory_region_add_subregion(memory, mpu_base, &s->clkm_iomem); |
1836 | e7aa0ae0 | Avi Kivity | memory_region_add_subregion(memory, dsp_base, &s->clkdsp_iomem); |
1837 | c3d2689d | balrog | } |
1838 | c3d2689d | balrog | |
1839 | fe71e81a | balrog | /* MPU I/O */
|
1840 | fe71e81a | balrog | struct omap_mpuio_s {
|
1841 | fe71e81a | balrog | qemu_irq irq; |
1842 | fe71e81a | balrog | qemu_irq kbd_irq; |
1843 | fe71e81a | balrog | qemu_irq *in; |
1844 | fe71e81a | balrog | qemu_irq handler[16];
|
1845 | fe71e81a | balrog | qemu_irq wakeup; |
1846 | e7aa0ae0 | Avi Kivity | MemoryRegion iomem; |
1847 | fe71e81a | balrog | |
1848 | fe71e81a | balrog | uint16_t inputs; |
1849 | fe71e81a | balrog | uint16_t outputs; |
1850 | fe71e81a | balrog | uint16_t dir; |
1851 | fe71e81a | balrog | uint16_t edge; |
1852 | fe71e81a | balrog | uint16_t mask; |
1853 | fe71e81a | balrog | uint16_t ints; |
1854 | fe71e81a | balrog | |
1855 | fe71e81a | balrog | uint16_t debounce; |
1856 | fe71e81a | balrog | uint16_t latch; |
1857 | fe71e81a | balrog | uint8_t event; |
1858 | fe71e81a | balrog | |
1859 | fe71e81a | balrog | uint8_t buttons[5];
|
1860 | fe71e81a | balrog | uint8_t row_latch; |
1861 | fe71e81a | balrog | uint8_t cols; |
1862 | fe71e81a | balrog | int kbd_mask;
|
1863 | fe71e81a | balrog | int clk;
|
1864 | fe71e81a | balrog | }; |
1865 | fe71e81a | balrog | |
1866 | fe71e81a | balrog | static void omap_mpuio_set(void *opaque, int line, int level) |
1867 | fe71e81a | balrog | { |
1868 | fe71e81a | balrog | struct omap_mpuio_s *s = (struct omap_mpuio_s *) opaque; |
1869 | fe71e81a | balrog | uint16_t prev = s->inputs; |
1870 | fe71e81a | balrog | |
1871 | fe71e81a | balrog | if (level)
|
1872 | fe71e81a | balrog | s->inputs |= 1 << line;
|
1873 | fe71e81a | balrog | else
|
1874 | fe71e81a | balrog | s->inputs &= ~(1 << line);
|
1875 | fe71e81a | balrog | |
1876 | fe71e81a | balrog | if (((1 << line) & s->dir & ~s->mask) && s->clk) { |
1877 | fe71e81a | balrog | if ((s->edge & s->inputs & ~prev) | (~s->edge & ~s->inputs & prev)) {
|
1878 | fe71e81a | balrog | s->ints |= 1 << line;
|
1879 | fe71e81a | balrog | qemu_irq_raise(s->irq); |
1880 | fe71e81a | balrog | /* TODO: wakeup */
|
1881 | fe71e81a | balrog | } |
1882 | fe71e81a | balrog | if ((s->event & (1 << 0)) && /* SET_GPIO_EVENT_MODE */ |
1883 | fe71e81a | balrog | (s->event >> 1) == line) /* PIN_SELECT */ |
1884 | fe71e81a | balrog | s->latch = s->inputs; |
1885 | fe71e81a | balrog | } |
1886 | fe71e81a | balrog | } |
1887 | fe71e81a | balrog | |
1888 | fe71e81a | balrog | static void omap_mpuio_kbd_update(struct omap_mpuio_s *s) |
1889 | fe71e81a | balrog | { |
1890 | fe71e81a | balrog | int i;
|
1891 | fe71e81a | balrog | uint8_t *row, rows = 0, cols = ~s->cols;
|
1892 | fe71e81a | balrog | |
1893 | 38a34e1d | balrog | for (row = s->buttons + 4, i = 1 << 4; i; row --, i >>= 1) |
1894 | fe71e81a | balrog | if (*row & cols)
|
1895 | 38a34e1d | balrog | rows |= i; |
1896 | fe71e81a | balrog | |
1897 | cf6d9118 | balrog | qemu_set_irq(s->kbd_irq, rows && !s->kbd_mask && s->clk); |
1898 | cf6d9118 | balrog | s->row_latch = ~rows; |
1899 | fe71e81a | balrog | } |
1900 | fe71e81a | balrog | |
1901 | e7aa0ae0 | Avi Kivity | static uint64_t omap_mpuio_read(void *opaque, target_phys_addr_t addr, |
1902 | e7aa0ae0 | Avi Kivity | unsigned size)
|
1903 | fe71e81a | balrog | { |
1904 | fe71e81a | balrog | struct omap_mpuio_s *s = (struct omap_mpuio_s *) opaque; |
1905 | cf965d24 | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
1906 | fe71e81a | balrog | uint16_t ret; |
1907 | fe71e81a | balrog | |
1908 | e7aa0ae0 | Avi Kivity | if (size != 2) { |
1909 | e7aa0ae0 | Avi Kivity | return omap_badwidth_read16(opaque, addr);
|
1910 | e7aa0ae0 | Avi Kivity | } |
1911 | e7aa0ae0 | Avi Kivity | |
1912 | fe71e81a | balrog | switch (offset) {
|
1913 | fe71e81a | balrog | case 0x00: /* INPUT_LATCH */ |
1914 | fe71e81a | balrog | return s->inputs;
|
1915 | fe71e81a | balrog | |
1916 | fe71e81a | balrog | case 0x04: /* OUTPUT_REG */ |
1917 | fe71e81a | balrog | return s->outputs;
|
1918 | fe71e81a | balrog | |
1919 | fe71e81a | balrog | case 0x08: /* IO_CNTL */ |
1920 | fe71e81a | balrog | return s->dir;
|
1921 | fe71e81a | balrog | |
1922 | fe71e81a | balrog | case 0x10: /* KBR_LATCH */ |
1923 | fe71e81a | balrog | return s->row_latch;
|
1924 | fe71e81a | balrog | |
1925 | fe71e81a | balrog | case 0x14: /* KBC_REG */ |
1926 | fe71e81a | balrog | return s->cols;
|
1927 | fe71e81a | balrog | |
1928 | fe71e81a | balrog | case 0x18: /* GPIO_EVENT_MODE_REG */ |
1929 | fe71e81a | balrog | return s->event;
|
1930 | fe71e81a | balrog | |
1931 | fe71e81a | balrog | case 0x1c: /* GPIO_INT_EDGE_REG */ |
1932 | fe71e81a | balrog | return s->edge;
|
1933 | fe71e81a | balrog | |
1934 | fe71e81a | balrog | case 0x20: /* KBD_INT */ |
1935 | cf6d9118 | balrog | return (~s->row_latch & 0x1f) && !s->kbd_mask; |
1936 | fe71e81a | balrog | |
1937 | fe71e81a | balrog | case 0x24: /* GPIO_INT */ |
1938 | fe71e81a | balrog | ret = s->ints; |
1939 | 8e129e07 | balrog | s->ints &= s->mask; |
1940 | 8e129e07 | balrog | if (ret)
|
1941 | 8e129e07 | balrog | qemu_irq_lower(s->irq); |
1942 | fe71e81a | balrog | return ret;
|
1943 | fe71e81a | balrog | |
1944 | fe71e81a | balrog | case 0x28: /* KBD_MASKIT */ |
1945 | fe71e81a | balrog | return s->kbd_mask;
|
1946 | fe71e81a | balrog | |
1947 | fe71e81a | balrog | case 0x2c: /* GPIO_MASKIT */ |
1948 | fe71e81a | balrog | return s->mask;
|
1949 | fe71e81a | balrog | |
1950 | fe71e81a | balrog | case 0x30: /* GPIO_DEBOUNCING_REG */ |
1951 | fe71e81a | balrog | return s->debounce;
|
1952 | fe71e81a | balrog | |
1953 | fe71e81a | balrog | case 0x34: /* GPIO_LATCH_REG */ |
1954 | fe71e81a | balrog | return s->latch;
|
1955 | fe71e81a | balrog | } |
1956 | fe71e81a | balrog | |
1957 | fe71e81a | balrog | OMAP_BAD_REG(addr); |
1958 | fe71e81a | balrog | return 0; |
1959 | fe71e81a | balrog | } |
1960 | fe71e81a | balrog | |
1961 | c227f099 | Anthony Liguori | static void omap_mpuio_write(void *opaque, target_phys_addr_t addr, |
1962 | e7aa0ae0 | Avi Kivity | uint64_t value, unsigned size)
|
1963 | fe71e81a | balrog | { |
1964 | fe71e81a | balrog | struct omap_mpuio_s *s = (struct omap_mpuio_s *) opaque; |
1965 | cf965d24 | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
1966 | fe71e81a | balrog | uint16_t diff; |
1967 | fe71e81a | balrog | int ln;
|
1968 | fe71e81a | balrog | |
1969 | e7aa0ae0 | Avi Kivity | if (size != 2) { |
1970 | e7aa0ae0 | Avi Kivity | return omap_badwidth_write16(opaque, addr, value);
|
1971 | e7aa0ae0 | Avi Kivity | } |
1972 | e7aa0ae0 | Avi Kivity | |
1973 | fe71e81a | balrog | switch (offset) {
|
1974 | fe71e81a | balrog | case 0x04: /* OUTPUT_REG */ |
1975 | d8f699cb | balrog | diff = (s->outputs ^ value) & ~s->dir; |
1976 | fe71e81a | balrog | s->outputs = value; |
1977 | fe71e81a | balrog | while ((ln = ffs(diff))) {
|
1978 | fe71e81a | balrog | ln --; |
1979 | fe71e81a | balrog | if (s->handler[ln])
|
1980 | fe71e81a | balrog | qemu_set_irq(s->handler[ln], (value >> ln) & 1);
|
1981 | fe71e81a | balrog | diff &= ~(1 << ln);
|
1982 | fe71e81a | balrog | } |
1983 | fe71e81a | balrog | break;
|
1984 | fe71e81a | balrog | |
1985 | fe71e81a | balrog | case 0x08: /* IO_CNTL */ |
1986 | fe71e81a | balrog | diff = s->outputs & (s->dir ^ value); |
1987 | fe71e81a | balrog | s->dir = value; |
1988 | fe71e81a | balrog | |
1989 | fe71e81a | balrog | value = s->outputs & ~s->dir; |
1990 | fe71e81a | balrog | while ((ln = ffs(diff))) {
|
1991 | fe71e81a | balrog | ln --; |
1992 | fe71e81a | balrog | if (s->handler[ln])
|
1993 | fe71e81a | balrog | qemu_set_irq(s->handler[ln], (value >> ln) & 1);
|
1994 | fe71e81a | balrog | diff &= ~(1 << ln);
|
1995 | fe71e81a | balrog | } |
1996 | fe71e81a | balrog | break;
|
1997 | fe71e81a | balrog | |
1998 | fe71e81a | balrog | case 0x14: /* KBC_REG */ |
1999 | fe71e81a | balrog | s->cols = value; |
2000 | fe71e81a | balrog | omap_mpuio_kbd_update(s); |
2001 | fe71e81a | balrog | break;
|
2002 | fe71e81a | balrog | |
2003 | fe71e81a | balrog | case 0x18: /* GPIO_EVENT_MODE_REG */ |
2004 | fe71e81a | balrog | s->event = value & 0x1f;
|
2005 | fe71e81a | balrog | break;
|
2006 | fe71e81a | balrog | |
2007 | fe71e81a | balrog | case 0x1c: /* GPIO_INT_EDGE_REG */ |
2008 | fe71e81a | balrog | s->edge = value; |
2009 | fe71e81a | balrog | break;
|
2010 | fe71e81a | balrog | |
2011 | fe71e81a | balrog | case 0x28: /* KBD_MASKIT */ |
2012 | fe71e81a | balrog | s->kbd_mask = value & 1;
|
2013 | fe71e81a | balrog | omap_mpuio_kbd_update(s); |
2014 | fe71e81a | balrog | break;
|
2015 | fe71e81a | balrog | |
2016 | fe71e81a | balrog | case 0x2c: /* GPIO_MASKIT */ |
2017 | fe71e81a | balrog | s->mask = value; |
2018 | fe71e81a | balrog | break;
|
2019 | fe71e81a | balrog | |
2020 | fe71e81a | balrog | case 0x30: /* GPIO_DEBOUNCING_REG */ |
2021 | fe71e81a | balrog | s->debounce = value & 0x1ff;
|
2022 | fe71e81a | balrog | break;
|
2023 | fe71e81a | balrog | |
2024 | fe71e81a | balrog | case 0x00: /* INPUT_LATCH */ |
2025 | fe71e81a | balrog | case 0x10: /* KBR_LATCH */ |
2026 | fe71e81a | balrog | case 0x20: /* KBD_INT */ |
2027 | fe71e81a | balrog | case 0x24: /* GPIO_INT */ |
2028 | fe71e81a | balrog | case 0x34: /* GPIO_LATCH_REG */ |
2029 | fe71e81a | balrog | OMAP_RO_REG(addr); |
2030 | fe71e81a | balrog | return;
|
2031 | fe71e81a | balrog | |
2032 | fe71e81a | balrog | default:
|
2033 | fe71e81a | balrog | OMAP_BAD_REG(addr); |
2034 | fe71e81a | balrog | return;
|
2035 | fe71e81a | balrog | } |
2036 | fe71e81a | balrog | } |
2037 | fe71e81a | balrog | |
2038 | e7aa0ae0 | Avi Kivity | static const MemoryRegionOps omap_mpuio_ops = { |
2039 | e7aa0ae0 | Avi Kivity | .read = omap_mpuio_read, |
2040 | e7aa0ae0 | Avi Kivity | .write = omap_mpuio_write, |
2041 | e7aa0ae0 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
2042 | fe71e81a | balrog | }; |
2043 | fe71e81a | balrog | |
2044 | 9596ebb7 | pbrook | static void omap_mpuio_reset(struct omap_mpuio_s *s) |
2045 | fe71e81a | balrog | { |
2046 | fe71e81a | balrog | s->inputs = 0;
|
2047 | fe71e81a | balrog | s->outputs = 0;
|
2048 | fe71e81a | balrog | s->dir = ~0;
|
2049 | fe71e81a | balrog | s->event = 0;
|
2050 | fe71e81a | balrog | s->edge = 0;
|
2051 | fe71e81a | balrog | s->kbd_mask = 0;
|
2052 | fe71e81a | balrog | s->mask = 0;
|
2053 | fe71e81a | balrog | s->debounce = 0;
|
2054 | fe71e81a | balrog | s->latch = 0;
|
2055 | fe71e81a | balrog | s->ints = 0;
|
2056 | fe71e81a | balrog | s->row_latch = 0x1f;
|
2057 | 38a34e1d | balrog | s->clk = 1;
|
2058 | fe71e81a | balrog | } |
2059 | fe71e81a | balrog | |
2060 | fe71e81a | balrog | static void omap_mpuio_onoff(void *opaque, int line, int on) |
2061 | fe71e81a | balrog | { |
2062 | fe71e81a | balrog | struct omap_mpuio_s *s = (struct omap_mpuio_s *) opaque; |
2063 | fe71e81a | balrog | |
2064 | fe71e81a | balrog | s->clk = on; |
2065 | fe71e81a | balrog | if (on)
|
2066 | fe71e81a | balrog | omap_mpuio_kbd_update(s); |
2067 | fe71e81a | balrog | } |
2068 | fe71e81a | balrog | |
2069 | e7aa0ae0 | Avi Kivity | struct omap_mpuio_s *omap_mpuio_init(MemoryRegion *memory,
|
2070 | e7aa0ae0 | Avi Kivity | target_phys_addr_t base, |
2071 | fe71e81a | balrog | qemu_irq kbd_int, qemu_irq gpio_int, qemu_irq wakeup, |
2072 | fe71e81a | balrog | omap_clk clk) |
2073 | fe71e81a | balrog | { |
2074 | fe71e81a | balrog | struct omap_mpuio_s *s = (struct omap_mpuio_s *) |
2075 | 7267c094 | Anthony Liguori | g_malloc0(sizeof(struct omap_mpuio_s)); |
2076 | fe71e81a | balrog | |
2077 | fe71e81a | balrog | s->irq = gpio_int; |
2078 | fe71e81a | balrog | s->kbd_irq = kbd_int; |
2079 | fe71e81a | balrog | s->wakeup = wakeup; |
2080 | fe71e81a | balrog | s->in = qemu_allocate_irqs(omap_mpuio_set, s, 16);
|
2081 | fe71e81a | balrog | omap_mpuio_reset(s); |
2082 | fe71e81a | balrog | |
2083 | e7aa0ae0 | Avi Kivity | memory_region_init_io(&s->iomem, &omap_mpuio_ops, s, |
2084 | e7aa0ae0 | Avi Kivity | "omap-mpuio", 0x800); |
2085 | e7aa0ae0 | Avi Kivity | memory_region_add_subregion(memory, base, &s->iomem); |
2086 | fe71e81a | balrog | |
2087 | fe71e81a | balrog | omap_clk_adduser(clk, qemu_allocate_irqs(omap_mpuio_onoff, s, 1)[0]); |
2088 | fe71e81a | balrog | |
2089 | fe71e81a | balrog | return s;
|
2090 | fe71e81a | balrog | } |
2091 | fe71e81a | balrog | |
2092 | fe71e81a | balrog | qemu_irq *omap_mpuio_in_get(struct omap_mpuio_s *s)
|
2093 | fe71e81a | balrog | { |
2094 | fe71e81a | balrog | return s->in;
|
2095 | fe71e81a | balrog | } |
2096 | fe71e81a | balrog | |
2097 | fe71e81a | balrog | void omap_mpuio_out_set(struct omap_mpuio_s *s, int line, qemu_irq handler) |
2098 | fe71e81a | balrog | { |
2099 | fe71e81a | balrog | if (line >= 16 || line < 0) |
2100 | 2ac71179 | Paul Brook | hw_error("%s: No GPIO line %i\n", __FUNCTION__, line);
|
2101 | fe71e81a | balrog | s->handler[line] = handler; |
2102 | fe71e81a | balrog | } |
2103 | fe71e81a | balrog | |
2104 | fe71e81a | balrog | void omap_mpuio_key(struct omap_mpuio_s *s, int row, int col, int down) |
2105 | fe71e81a | balrog | { |
2106 | fe71e81a | balrog | if (row >= 5 || row < 0) |
2107 | 2ac71179 | Paul Brook | hw_error("%s: No key %i-%i\n", __FUNCTION__, col, row);
|
2108 | fe71e81a | balrog | |
2109 | fe71e81a | balrog | if (down)
|
2110 | 38a34e1d | balrog | s->buttons[row] |= 1 << col;
|
2111 | fe71e81a | balrog | else
|
2112 | 38a34e1d | balrog | s->buttons[row] &= ~(1 << col);
|
2113 | fe71e81a | balrog | |
2114 | fe71e81a | balrog | omap_mpuio_kbd_update(s); |
2115 | fe71e81a | balrog | } |
2116 | fe71e81a | balrog | |
2117 | d951f6ff | balrog | /* MicroWire Interface */
|
2118 | d951f6ff | balrog | struct omap_uwire_s {
|
2119 | a4ebbd18 | Avi Kivity | MemoryRegion iomem; |
2120 | d951f6ff | balrog | qemu_irq txirq; |
2121 | d951f6ff | balrog | qemu_irq rxirq; |
2122 | d951f6ff | balrog | qemu_irq txdrq; |
2123 | d951f6ff | balrog | |
2124 | d951f6ff | balrog | uint16_t txbuf; |
2125 | d951f6ff | balrog | uint16_t rxbuf; |
2126 | d951f6ff | balrog | uint16_t control; |
2127 | d951f6ff | balrog | uint16_t setup[5];
|
2128 | d951f6ff | balrog | |
2129 | bc24a225 | Paul Brook | uWireSlave *chip[4];
|
2130 | d951f6ff | balrog | }; |
2131 | d951f6ff | balrog | |
2132 | d951f6ff | balrog | static void omap_uwire_transfer_start(struct omap_uwire_s *s) |
2133 | d951f6ff | balrog | { |
2134 | d951f6ff | balrog | int chipselect = (s->control >> 10) & 3; /* INDEX */ |
2135 | bc24a225 | Paul Brook | uWireSlave *slave = s->chip[chipselect]; |
2136 | d951f6ff | balrog | |
2137 | d951f6ff | balrog | if ((s->control >> 5) & 0x1f) { /* NB_BITS_WR */ |
2138 | d951f6ff | balrog | if (s->control & (1 << 12)) /* CS_CMD */ |
2139 | d951f6ff | balrog | if (slave && slave->send)
|
2140 | d951f6ff | balrog | slave->send(slave->opaque, |
2141 | d951f6ff | balrog | s->txbuf >> (16 - ((s->control >> 5) & 0x1f))); |
2142 | d951f6ff | balrog | s->control &= ~(1 << 14); /* CSRB */ |
2143 | d951f6ff | balrog | /* TODO: depending on s->setup[4] bits [1:0] assert an IRQ or
|
2144 | d951f6ff | balrog | * a DRQ. When is the level IRQ supposed to be reset? */
|
2145 | d951f6ff | balrog | } |
2146 | d951f6ff | balrog | |
2147 | d951f6ff | balrog | if ((s->control >> 0) & 0x1f) { /* NB_BITS_RD */ |
2148 | d951f6ff | balrog | if (s->control & (1 << 12)) /* CS_CMD */ |
2149 | d951f6ff | balrog | if (slave && slave->receive)
|
2150 | d951f6ff | balrog | s->rxbuf = slave->receive(slave->opaque); |
2151 | d951f6ff | balrog | s->control |= 1 << 15; /* RDRB */ |
2152 | d951f6ff | balrog | /* TODO: depending on s->setup[4] bits [1:0] assert an IRQ or
|
2153 | d951f6ff | balrog | * a DRQ. When is the level IRQ supposed to be reset? */
|
2154 | d951f6ff | balrog | } |
2155 | d951f6ff | balrog | } |
2156 | d951f6ff | balrog | |
2157 | a4ebbd18 | Avi Kivity | static uint64_t omap_uwire_read(void *opaque, target_phys_addr_t addr, |
2158 | a4ebbd18 | Avi Kivity | unsigned size)
|
2159 | d951f6ff | balrog | { |
2160 | d951f6ff | balrog | struct omap_uwire_s *s = (struct omap_uwire_s *) opaque; |
2161 | cf965d24 | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
2162 | d951f6ff | balrog | |
2163 | a4ebbd18 | Avi Kivity | if (size != 2) { |
2164 | a4ebbd18 | Avi Kivity | return omap_badwidth_read16(opaque, addr);
|
2165 | a4ebbd18 | Avi Kivity | } |
2166 | a4ebbd18 | Avi Kivity | |
2167 | d951f6ff | balrog | switch (offset) {
|
2168 | d951f6ff | balrog | case 0x00: /* RDR */ |
2169 | d951f6ff | balrog | s->control &= ~(1 << 15); /* RDRB */ |
2170 | d951f6ff | balrog | return s->rxbuf;
|
2171 | d951f6ff | balrog | |
2172 | d951f6ff | balrog | case 0x04: /* CSR */ |
2173 | d951f6ff | balrog | return s->control;
|
2174 | d951f6ff | balrog | |
2175 | d951f6ff | balrog | case 0x08: /* SR1 */ |
2176 | d951f6ff | balrog | return s->setup[0]; |
2177 | d951f6ff | balrog | case 0x0c: /* SR2 */ |
2178 | d951f6ff | balrog | return s->setup[1]; |
2179 | d951f6ff | balrog | case 0x10: /* SR3 */ |
2180 | d951f6ff | balrog | return s->setup[2]; |
2181 | d951f6ff | balrog | case 0x14: /* SR4 */ |
2182 | d951f6ff | balrog | return s->setup[3]; |
2183 | d951f6ff | balrog | case 0x18: /* SR5 */ |
2184 | d951f6ff | balrog | return s->setup[4]; |
2185 | d951f6ff | balrog | } |
2186 | d951f6ff | balrog | |
2187 | d951f6ff | balrog | OMAP_BAD_REG(addr); |
2188 | d951f6ff | balrog | return 0; |
2189 | d951f6ff | balrog | } |
2190 | d951f6ff | balrog | |
2191 | c227f099 | Anthony Liguori | static void omap_uwire_write(void *opaque, target_phys_addr_t addr, |
2192 | a4ebbd18 | Avi Kivity | uint64_t value, unsigned size)
|
2193 | d951f6ff | balrog | { |
2194 | d951f6ff | balrog | struct omap_uwire_s *s = (struct omap_uwire_s *) opaque; |
2195 | cf965d24 | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
2196 | d951f6ff | balrog | |
2197 | a4ebbd18 | Avi Kivity | if (size != 2) { |
2198 | a4ebbd18 | Avi Kivity | return omap_badwidth_write16(opaque, addr, value);
|
2199 | a4ebbd18 | Avi Kivity | } |
2200 | a4ebbd18 | Avi Kivity | |
2201 | d951f6ff | balrog | switch (offset) {
|
2202 | d951f6ff | balrog | case 0x00: /* TDR */ |
2203 | d951f6ff | balrog | s->txbuf = value; /* TD */
|
2204 | d951f6ff | balrog | if ((s->setup[4] & (1 << 2)) && /* AUTO_TX_EN */ |
2205 | d951f6ff | balrog | ((s->setup[4] & (1 << 3)) || /* CS_TOGGLE_TX_EN */ |
2206 | cf965d24 | balrog | (s->control & (1 << 12)))) { /* CS_CMD */ |
2207 | cf965d24 | balrog | s->control |= 1 << 14; /* CSRB */ |
2208 | d951f6ff | balrog | omap_uwire_transfer_start(s); |
2209 | cf965d24 | balrog | } |
2210 | d951f6ff | balrog | break;
|
2211 | d951f6ff | balrog | |
2212 | d951f6ff | balrog | case 0x04: /* CSR */ |
2213 | d951f6ff | balrog | s->control = value & 0x1fff;
|
2214 | d951f6ff | balrog | if (value & (1 << 13)) /* START */ |
2215 | d951f6ff | balrog | omap_uwire_transfer_start(s); |
2216 | d951f6ff | balrog | break;
|
2217 | d951f6ff | balrog | |
2218 | d951f6ff | balrog | case 0x08: /* SR1 */ |
2219 | d951f6ff | balrog | s->setup[0] = value & 0x003f; |
2220 | d951f6ff | balrog | break;
|
2221 | d951f6ff | balrog | |
2222 | d951f6ff | balrog | case 0x0c: /* SR2 */ |
2223 | d951f6ff | balrog | s->setup[1] = value & 0x0fc0; |
2224 | d951f6ff | balrog | break;
|
2225 | d951f6ff | balrog | |
2226 | d951f6ff | balrog | case 0x10: /* SR3 */ |
2227 | d951f6ff | balrog | s->setup[2] = value & 0x0003; |
2228 | d951f6ff | balrog | break;
|
2229 | d951f6ff | balrog | |
2230 | d951f6ff | balrog | case 0x14: /* SR4 */ |
2231 | d951f6ff | balrog | s->setup[3] = value & 0x0001; |
2232 | d951f6ff | balrog | break;
|
2233 | d951f6ff | balrog | |
2234 | d951f6ff | balrog | case 0x18: /* SR5 */ |
2235 | d951f6ff | balrog | s->setup[4] = value & 0x000f; |
2236 | d951f6ff | balrog | break;
|
2237 | d951f6ff | balrog | |
2238 | d951f6ff | balrog | default:
|
2239 | d951f6ff | balrog | OMAP_BAD_REG(addr); |
2240 | d951f6ff | balrog | return;
|
2241 | d951f6ff | balrog | } |
2242 | d951f6ff | balrog | } |
2243 | d951f6ff | balrog | |
2244 | a4ebbd18 | Avi Kivity | static const MemoryRegionOps omap_uwire_ops = { |
2245 | a4ebbd18 | Avi Kivity | .read = omap_uwire_read, |
2246 | a4ebbd18 | Avi Kivity | .write = omap_uwire_write, |
2247 | a4ebbd18 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
2248 | d951f6ff | balrog | }; |
2249 | d951f6ff | balrog | |
2250 | 9596ebb7 | pbrook | static void omap_uwire_reset(struct omap_uwire_s *s) |
2251 | d951f6ff | balrog | { |
2252 | 66450b15 | balrog | s->control = 0;
|
2253 | d951f6ff | balrog | s->setup[0] = 0; |
2254 | d951f6ff | balrog | s->setup[1] = 0; |
2255 | d951f6ff | balrog | s->setup[2] = 0; |
2256 | d951f6ff | balrog | s->setup[3] = 0; |
2257 | d951f6ff | balrog | s->setup[4] = 0; |
2258 | d951f6ff | balrog | } |
2259 | d951f6ff | balrog | |
2260 | 0919ac78 | Peter Maydell | static struct omap_uwire_s *omap_uwire_init(MemoryRegion *system_memory, |
2261 | 0919ac78 | Peter Maydell | target_phys_addr_t base, |
2262 | 0919ac78 | Peter Maydell | qemu_irq txirq, qemu_irq rxirq, |
2263 | 0919ac78 | Peter Maydell | qemu_irq dma, |
2264 | 0919ac78 | Peter Maydell | omap_clk clk) |
2265 | d951f6ff | balrog | { |
2266 | d951f6ff | balrog | struct omap_uwire_s *s = (struct omap_uwire_s *) |
2267 | 7267c094 | Anthony Liguori | g_malloc0(sizeof(struct omap_uwire_s)); |
2268 | d951f6ff | balrog | |
2269 | 0919ac78 | Peter Maydell | s->txirq = txirq; |
2270 | 0919ac78 | Peter Maydell | s->rxirq = rxirq; |
2271 | d951f6ff | balrog | s->txdrq = dma; |
2272 | d951f6ff | balrog | omap_uwire_reset(s); |
2273 | d951f6ff | balrog | |
2274 | a4ebbd18 | Avi Kivity | memory_region_init_io(&s->iomem, &omap_uwire_ops, s, "omap-uwire", 0x800); |
2275 | a4ebbd18 | Avi Kivity | memory_region_add_subregion(system_memory, base, &s->iomem); |
2276 | d951f6ff | balrog | |
2277 | d951f6ff | balrog | return s;
|
2278 | d951f6ff | balrog | } |
2279 | d951f6ff | balrog | |
2280 | d951f6ff | balrog | void omap_uwire_attach(struct omap_uwire_s *s, |
2281 | bc24a225 | Paul Brook | uWireSlave *slave, int chipselect)
|
2282 | d951f6ff | balrog | { |
2283 | 827df9f3 | balrog | if (chipselect < 0 || chipselect > 3) { |
2284 | 827df9f3 | balrog | fprintf(stderr, "%s: Bad chipselect %i\n", __FUNCTION__, chipselect);
|
2285 | 827df9f3 | balrog | exit(-1);
|
2286 | 827df9f3 | balrog | } |
2287 | d951f6ff | balrog | |
2288 | d951f6ff | balrog | s->chip[chipselect] = slave; |
2289 | d951f6ff | balrog | } |
2290 | d951f6ff | balrog | |
2291 | 66450b15 | balrog | /* Pseudonoise Pulse-Width Light Modulator */
|
2292 | 9596ebb7 | pbrook | static void omap_pwl_update(struct omap_mpu_state_s *s) |
2293 | 66450b15 | balrog | { |
2294 | 66450b15 | balrog | int output = (s->pwl.clk && s->pwl.enable) ? s->pwl.level : 0; |
2295 | 66450b15 | balrog | |
2296 | 66450b15 | balrog | if (output != s->pwl.output) {
|
2297 | 66450b15 | balrog | s->pwl.output = output; |
2298 | 66450b15 | balrog | printf("%s: Backlight now at %i/256\n", __FUNCTION__, output);
|
2299 | 66450b15 | balrog | } |
2300 | 66450b15 | balrog | } |
2301 | 66450b15 | balrog | |
2302 | a4ebbd18 | Avi Kivity | static uint64_t omap_pwl_read(void *opaque, target_phys_addr_t addr, |
2303 | a4ebbd18 | Avi Kivity | unsigned size)
|
2304 | 66450b15 | balrog | { |
2305 | 66450b15 | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
2306 | cf965d24 | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
2307 | 66450b15 | balrog | |
2308 | a4ebbd18 | Avi Kivity | if (size != 1) { |
2309 | a4ebbd18 | Avi Kivity | return omap_badwidth_read8(opaque, addr);
|
2310 | a4ebbd18 | Avi Kivity | } |
2311 | a4ebbd18 | Avi Kivity | |
2312 | 66450b15 | balrog | switch (offset) {
|
2313 | 66450b15 | balrog | case 0x00: /* PWL_LEVEL */ |
2314 | 66450b15 | balrog | return s->pwl.level;
|
2315 | 66450b15 | balrog | case 0x04: /* PWL_CTRL */ |
2316 | 66450b15 | balrog | return s->pwl.enable;
|
2317 | 66450b15 | balrog | } |
2318 | 66450b15 | balrog | OMAP_BAD_REG(addr); |
2319 | 66450b15 | balrog | return 0; |
2320 | 66450b15 | balrog | } |
2321 | 66450b15 | balrog | |
2322 | c227f099 | Anthony Liguori | static void omap_pwl_write(void *opaque, target_phys_addr_t addr, |
2323 | a4ebbd18 | Avi Kivity | uint64_t value, unsigned size)
|
2324 | 66450b15 | balrog | { |
2325 | 66450b15 | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
2326 | cf965d24 | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
2327 | 66450b15 | balrog | |
2328 | a4ebbd18 | Avi Kivity | if (size != 1) { |
2329 | a4ebbd18 | Avi Kivity | return omap_badwidth_write8(opaque, addr, value);
|
2330 | a4ebbd18 | Avi Kivity | } |
2331 | a4ebbd18 | Avi Kivity | |
2332 | 66450b15 | balrog | switch (offset) {
|
2333 | 66450b15 | balrog | case 0x00: /* PWL_LEVEL */ |
2334 | 66450b15 | balrog | s->pwl.level = value; |
2335 | 66450b15 | balrog | omap_pwl_update(s); |
2336 | 66450b15 | balrog | break;
|
2337 | 66450b15 | balrog | case 0x04: /* PWL_CTRL */ |
2338 | 66450b15 | balrog | s->pwl.enable = value & 1;
|
2339 | 66450b15 | balrog | omap_pwl_update(s); |
2340 | 66450b15 | balrog | break;
|
2341 | 66450b15 | balrog | default:
|
2342 | 66450b15 | balrog | OMAP_BAD_REG(addr); |
2343 | 66450b15 | balrog | return;
|
2344 | 66450b15 | balrog | } |
2345 | 66450b15 | balrog | } |
2346 | 66450b15 | balrog | |
2347 | a4ebbd18 | Avi Kivity | static const MemoryRegionOps omap_pwl_ops = { |
2348 | a4ebbd18 | Avi Kivity | .read = omap_pwl_read, |
2349 | a4ebbd18 | Avi Kivity | .write = omap_pwl_write, |
2350 | a4ebbd18 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
2351 | 66450b15 | balrog | }; |
2352 | 66450b15 | balrog | |
2353 | 9596ebb7 | pbrook | static void omap_pwl_reset(struct omap_mpu_state_s *s) |
2354 | 66450b15 | balrog | { |
2355 | 66450b15 | balrog | s->pwl.output = 0;
|
2356 | 66450b15 | balrog | s->pwl.level = 0;
|
2357 | 66450b15 | balrog | s->pwl.enable = 0;
|
2358 | 66450b15 | balrog | s->pwl.clk = 1;
|
2359 | 66450b15 | balrog | omap_pwl_update(s); |
2360 | 66450b15 | balrog | } |
2361 | 66450b15 | balrog | |
2362 | 66450b15 | balrog | static void omap_pwl_clk_update(void *opaque, int line, int on) |
2363 | 66450b15 | balrog | { |
2364 | 66450b15 | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
2365 | 66450b15 | balrog | |
2366 | 66450b15 | balrog | s->pwl.clk = on; |
2367 | 66450b15 | balrog | omap_pwl_update(s); |
2368 | 66450b15 | balrog | } |
2369 | 66450b15 | balrog | |
2370 | a4ebbd18 | Avi Kivity | static void omap_pwl_init(MemoryRegion *system_memory, |
2371 | a4ebbd18 | Avi Kivity | target_phys_addr_t base, struct omap_mpu_state_s *s,
|
2372 | 66450b15 | balrog | omap_clk clk) |
2373 | 66450b15 | balrog | { |
2374 | 66450b15 | balrog | omap_pwl_reset(s); |
2375 | 66450b15 | balrog | |
2376 | a4ebbd18 | Avi Kivity | memory_region_init_io(&s->pwl_iomem, &omap_pwl_ops, s, |
2377 | a4ebbd18 | Avi Kivity | "omap-pwl", 0x800); |
2378 | a4ebbd18 | Avi Kivity | memory_region_add_subregion(system_memory, base, &s->pwl_iomem); |
2379 | 66450b15 | balrog | |
2380 | 66450b15 | balrog | omap_clk_adduser(clk, qemu_allocate_irqs(omap_pwl_clk_update, s, 1)[0]); |
2381 | 66450b15 | balrog | } |
2382 | 66450b15 | balrog | |
2383 | f34c417b | balrog | /* Pulse-Width Tone module */
|
2384 | a4ebbd18 | Avi Kivity | static uint64_t omap_pwt_read(void *opaque, target_phys_addr_t addr, |
2385 | a4ebbd18 | Avi Kivity | unsigned size)
|
2386 | f34c417b | balrog | { |
2387 | f34c417b | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
2388 | cf965d24 | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
2389 | f34c417b | balrog | |
2390 | a4ebbd18 | Avi Kivity | if (size != 1) { |
2391 | a4ebbd18 | Avi Kivity | return omap_badwidth_read8(opaque, addr);
|
2392 | a4ebbd18 | Avi Kivity | } |
2393 | a4ebbd18 | Avi Kivity | |
2394 | f34c417b | balrog | switch (offset) {
|
2395 | f34c417b | balrog | case 0x00: /* FRC */ |
2396 | f34c417b | balrog | return s->pwt.frc;
|
2397 | f34c417b | balrog | case 0x04: /* VCR */ |
2398 | f34c417b | balrog | return s->pwt.vrc;
|
2399 | f34c417b | balrog | case 0x08: /* GCR */ |
2400 | f34c417b | balrog | return s->pwt.gcr;
|
2401 | f34c417b | balrog | } |
2402 | f34c417b | balrog | OMAP_BAD_REG(addr); |
2403 | f34c417b | balrog | return 0; |
2404 | f34c417b | balrog | } |
2405 | f34c417b | balrog | |
2406 | c227f099 | Anthony Liguori | static void omap_pwt_write(void *opaque, target_phys_addr_t addr, |
2407 | a4ebbd18 | Avi Kivity | uint64_t value, unsigned size)
|
2408 | f34c417b | balrog | { |
2409 | f34c417b | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque; |
2410 | cf965d24 | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
2411 | f34c417b | balrog | |
2412 | a4ebbd18 | Avi Kivity | if (size != 1) { |
2413 | a4ebbd18 | Avi Kivity | return omap_badwidth_write8(opaque, addr, value);
|
2414 | a4ebbd18 | Avi Kivity | } |
2415 | a4ebbd18 | Avi Kivity | |
2416 | f34c417b | balrog | switch (offset) {
|
2417 | f34c417b | balrog | case 0x00: /* FRC */ |
2418 | f34c417b | balrog | s->pwt.frc = value & 0x3f;
|
2419 | f34c417b | balrog | break;
|
2420 | f34c417b | balrog | case 0x04: /* VRC */ |
2421 | f34c417b | balrog | if ((value ^ s->pwt.vrc) & 1) { |
2422 | f34c417b | balrog | if (value & 1) |
2423 | f34c417b | balrog | printf("%s: %iHz buzz on\n", __FUNCTION__, (int) |
2424 | f34c417b | balrog | /* 1.5 MHz from a 12-MHz or 13-MHz PWT_CLK */
|
2425 | f34c417b | balrog | ((omap_clk_getrate(s->pwt.clk) >> 3) /
|
2426 | f34c417b | balrog | /* Pre-multiplexer divider */
|
2427 | f34c417b | balrog | ((s->pwt.gcr & 2) ? 1 : 154) / |
2428 | f34c417b | balrog | /* Octave multiplexer */
|
2429 | f34c417b | balrog | (2 << (value & 3)) * |
2430 | f34c417b | balrog | /* 101/107 divider */
|
2431 | f34c417b | balrog | ((value & (1 << 2)) ? 101 : 107) * |
2432 | f34c417b | balrog | /* 49/55 divider */
|
2433 | f34c417b | balrog | ((value & (1 << 3)) ? 49 : 55) * |
2434 | f34c417b | balrog | /* 50/63 divider */
|
2435 | f34c417b | balrog | ((value & (1 << 4)) ? 50 : 63) * |
2436 | f34c417b | balrog | /* 80/127 divider */
|
2437 | f34c417b | balrog | ((value & (1 << 5)) ? 80 : 127) / |
2438 | f34c417b | balrog | (107 * 55 * 63 * 127))); |
2439 | f34c417b | balrog | else
|
2440 | f34c417b | balrog | printf("%s: silence!\n", __FUNCTION__);
|
2441 | f34c417b | balrog | } |
2442 | f34c417b | balrog | s->pwt.vrc = value & 0x7f;
|
2443 | f34c417b | balrog | break;
|
2444 | f34c417b | balrog | case 0x08: /* GCR */ |
2445 | f34c417b | balrog | s->pwt.gcr = value & 3;
|
2446 | f34c417b | balrog | break;
|
2447 | f34c417b | balrog | default:
|
2448 | f34c417b | balrog | OMAP_BAD_REG(addr); |
2449 | f34c417b | balrog | return;
|
2450 | f34c417b | balrog | } |
2451 | f34c417b | balrog | } |
2452 | f34c417b | balrog | |
2453 | a4ebbd18 | Avi Kivity | static const MemoryRegionOps omap_pwt_ops = { |
2454 | a4ebbd18 | Avi Kivity | .read =omap_pwt_read, |
2455 | a4ebbd18 | Avi Kivity | .write = omap_pwt_write, |
2456 | a4ebbd18 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
2457 | f34c417b | balrog | }; |
2458 | f34c417b | balrog | |
2459 | 9596ebb7 | pbrook | static void omap_pwt_reset(struct omap_mpu_state_s *s) |
2460 | f34c417b | balrog | { |
2461 | f34c417b | balrog | s->pwt.frc = 0;
|
2462 | f34c417b | balrog | s->pwt.vrc = 0;
|
2463 | f34c417b | balrog | s->pwt.gcr = 0;
|
2464 | f34c417b | balrog | } |
2465 | f34c417b | balrog | |
2466 | a4ebbd18 | Avi Kivity | static void omap_pwt_init(MemoryRegion *system_memory, |
2467 | a4ebbd18 | Avi Kivity | target_phys_addr_t base, struct omap_mpu_state_s *s,
|
2468 | f34c417b | balrog | omap_clk clk) |
2469 | f34c417b | balrog | { |
2470 | f34c417b | balrog | s->pwt.clk = clk; |
2471 | f34c417b | balrog | omap_pwt_reset(s); |
2472 | f34c417b | balrog | |
2473 | a4ebbd18 | Avi Kivity | memory_region_init_io(&s->pwt_iomem, &omap_pwt_ops, s, |
2474 | a4ebbd18 | Avi Kivity | "omap-pwt", 0x800); |
2475 | a4ebbd18 | Avi Kivity | memory_region_add_subregion(system_memory, base, &s->pwt_iomem); |
2476 | f34c417b | balrog | } |
2477 | f34c417b | balrog | |
2478 | 5c1c390f | balrog | /* Real-time Clock module */
|
2479 | 5c1c390f | balrog | struct omap_rtc_s {
|
2480 | a4ebbd18 | Avi Kivity | MemoryRegion iomem; |
2481 | 5c1c390f | balrog | qemu_irq irq; |
2482 | 5c1c390f | balrog | qemu_irq alarm; |
2483 | 5c1c390f | balrog | QEMUTimer *clk; |
2484 | 5c1c390f | balrog | |
2485 | 5c1c390f | balrog | uint8_t interrupts; |
2486 | 5c1c390f | balrog | uint8_t status; |
2487 | 5c1c390f | balrog | int16_t comp_reg; |
2488 | 5c1c390f | balrog | int running;
|
2489 | 5c1c390f | balrog | int pm_am;
|
2490 | 5c1c390f | balrog | int auto_comp;
|
2491 | 5c1c390f | balrog | int round;
|
2492 | 5c1c390f | balrog | struct tm alarm_tm;
|
2493 | 5c1c390f | balrog | time_t alarm_ti; |
2494 | 5c1c390f | balrog | |
2495 | 5c1c390f | balrog | struct tm current_tm;
|
2496 | 5c1c390f | balrog | time_t ti; |
2497 | 5c1c390f | balrog | uint64_t tick; |
2498 | 5c1c390f | balrog | }; |
2499 | 5c1c390f | balrog | |
2500 | 5c1c390f | balrog | static void omap_rtc_interrupts_update(struct omap_rtc_s *s) |
2501 | 5c1c390f | balrog | { |
2502 | 106627d0 | balrog | /* s->alarm is level-triggered */
|
2503 | 5c1c390f | balrog | qemu_set_irq(s->alarm, (s->status >> 6) & 1); |
2504 | 5c1c390f | balrog | } |
2505 | 5c1c390f | balrog | |
2506 | 5c1c390f | balrog | static void omap_rtc_alarm_update(struct omap_rtc_s *s) |
2507 | 5c1c390f | balrog | { |
2508 | 0cd2df75 | aurel32 | s->alarm_ti = mktimegm(&s->alarm_tm); |
2509 | 5c1c390f | balrog | if (s->alarm_ti == -1) |
2510 | 5c1c390f | balrog | printf("%s: conversion failed\n", __FUNCTION__);
|
2511 | 5c1c390f | balrog | } |
2512 | 5c1c390f | balrog | |
2513 | a4ebbd18 | Avi Kivity | static uint64_t omap_rtc_read(void *opaque, target_phys_addr_t addr, |
2514 | a4ebbd18 | Avi Kivity | unsigned size)
|
2515 | 5c1c390f | balrog | { |
2516 | 5c1c390f | balrog | struct omap_rtc_s *s = (struct omap_rtc_s *) opaque; |
2517 | cf965d24 | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
2518 | 5c1c390f | balrog | uint8_t i; |
2519 | 5c1c390f | balrog | |
2520 | a4ebbd18 | Avi Kivity | if (size != 1) { |
2521 | a4ebbd18 | Avi Kivity | return omap_badwidth_read8(opaque, addr);
|
2522 | a4ebbd18 | Avi Kivity | } |
2523 | a4ebbd18 | Avi Kivity | |
2524 | 5c1c390f | balrog | switch (offset) {
|
2525 | 5c1c390f | balrog | case 0x00: /* SECONDS_REG */ |
2526 | abd0c6bd | Paul Brook | return to_bcd(s->current_tm.tm_sec);
|
2527 | 5c1c390f | balrog | |
2528 | 5c1c390f | balrog | case 0x04: /* MINUTES_REG */ |
2529 | abd0c6bd | Paul Brook | return to_bcd(s->current_tm.tm_min);
|
2530 | 5c1c390f | balrog | |
2531 | 5c1c390f | balrog | case 0x08: /* HOURS_REG */ |
2532 | 5c1c390f | balrog | if (s->pm_am)
|
2533 | 5c1c390f | balrog | return ((s->current_tm.tm_hour > 11) << 7) | |
2534 | abd0c6bd | Paul Brook | to_bcd(((s->current_tm.tm_hour - 1) % 12) + 1); |
2535 | 5c1c390f | balrog | else
|
2536 | abd0c6bd | Paul Brook | return to_bcd(s->current_tm.tm_hour);
|
2537 | 5c1c390f | balrog | |
2538 | 5c1c390f | balrog | case 0x0c: /* DAYS_REG */ |
2539 | abd0c6bd | Paul Brook | return to_bcd(s->current_tm.tm_mday);
|
2540 | 5c1c390f | balrog | |
2541 | 5c1c390f | balrog | case 0x10: /* MONTHS_REG */ |
2542 | abd0c6bd | Paul Brook | return to_bcd(s->current_tm.tm_mon + 1); |
2543 | 5c1c390f | balrog | |
2544 | 5c1c390f | balrog | case 0x14: /* YEARS_REG */ |
2545 | abd0c6bd | Paul Brook | return to_bcd(s->current_tm.tm_year % 100); |
2546 | 5c1c390f | balrog | |
2547 | 5c1c390f | balrog | case 0x18: /* WEEK_REG */ |
2548 | 5c1c390f | balrog | return s->current_tm.tm_wday;
|
2549 | 5c1c390f | balrog | |
2550 | 5c1c390f | balrog | case 0x20: /* ALARM_SECONDS_REG */ |
2551 | abd0c6bd | Paul Brook | return to_bcd(s->alarm_tm.tm_sec);
|
2552 | 5c1c390f | balrog | |
2553 | 5c1c390f | balrog | case 0x24: /* ALARM_MINUTES_REG */ |
2554 | abd0c6bd | Paul Brook | return to_bcd(s->alarm_tm.tm_min);
|
2555 | 5c1c390f | balrog | |
2556 | 5c1c390f | balrog | case 0x28: /* ALARM_HOURS_REG */ |
2557 | 5c1c390f | balrog | if (s->pm_am)
|
2558 | 5c1c390f | balrog | return ((s->alarm_tm.tm_hour > 11) << 7) | |
2559 | abd0c6bd | Paul Brook | to_bcd(((s->alarm_tm.tm_hour - 1) % 12) + 1); |
2560 | 5c1c390f | balrog | else
|
2561 | abd0c6bd | Paul Brook | return to_bcd(s->alarm_tm.tm_hour);
|
2562 | 5c1c390f | balrog | |
2563 | 5c1c390f | balrog | case 0x2c: /* ALARM_DAYS_REG */ |
2564 | abd0c6bd | Paul Brook | return to_bcd(s->alarm_tm.tm_mday);
|
2565 | 5c1c390f | balrog | |
2566 | 5c1c390f | balrog | case 0x30: /* ALARM_MONTHS_REG */ |
2567 | abd0c6bd | Paul Brook | return to_bcd(s->alarm_tm.tm_mon + 1); |
2568 | 5c1c390f | balrog | |
2569 | 5c1c390f | balrog | case 0x34: /* ALARM_YEARS_REG */ |
2570 | abd0c6bd | Paul Brook | return to_bcd(s->alarm_tm.tm_year % 100); |
2571 | 5c1c390f | balrog | |
2572 | 5c1c390f | balrog | case 0x40: /* RTC_CTRL_REG */ |
2573 | 5c1c390f | balrog | return (s->pm_am << 3) | (s->auto_comp << 2) | |
2574 | 5c1c390f | balrog | (s->round << 1) | s->running;
|
2575 | 5c1c390f | balrog | |
2576 | 5c1c390f | balrog | case 0x44: /* RTC_STATUS_REG */ |
2577 | 5c1c390f | balrog | i = s->status; |
2578 | 5c1c390f | balrog | s->status &= ~0x3d;
|
2579 | 5c1c390f | balrog | return i;
|
2580 | 5c1c390f | balrog | |
2581 | 5c1c390f | balrog | case 0x48: /* RTC_INTERRUPTS_REG */ |
2582 | 5c1c390f | balrog | return s->interrupts;
|
2583 | 5c1c390f | balrog | |
2584 | 5c1c390f | balrog | case 0x4c: /* RTC_COMP_LSB_REG */ |
2585 | 5c1c390f | balrog | return ((uint16_t) s->comp_reg) & 0xff; |
2586 | 5c1c390f | balrog | |
2587 | 5c1c390f | balrog | case 0x50: /* RTC_COMP_MSB_REG */ |
2588 | 5c1c390f | balrog | return ((uint16_t) s->comp_reg) >> 8; |
2589 | 5c1c390f | balrog | } |
2590 | 5c1c390f | balrog | |
2591 | 5c1c390f | balrog | OMAP_BAD_REG(addr); |
2592 | 5c1c390f | balrog | return 0; |
2593 | 5c1c390f | balrog | } |
2594 | 5c1c390f | balrog | |
2595 | c227f099 | Anthony Liguori | static void omap_rtc_write(void *opaque, target_phys_addr_t addr, |
2596 | a4ebbd18 | Avi Kivity | uint64_t value, unsigned size)
|
2597 | 5c1c390f | balrog | { |
2598 | 5c1c390f | balrog | struct omap_rtc_s *s = (struct omap_rtc_s *) opaque; |
2599 | cf965d24 | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
2600 | 5c1c390f | balrog | struct tm new_tm;
|
2601 | 5c1c390f | balrog | time_t ti[2];
|
2602 | 5c1c390f | balrog | |
2603 | a4ebbd18 | Avi Kivity | if (size != 1) { |
2604 | a4ebbd18 | Avi Kivity | return omap_badwidth_write8(opaque, addr, value);
|
2605 | a4ebbd18 | Avi Kivity | } |
2606 | a4ebbd18 | Avi Kivity | |
2607 | 5c1c390f | balrog | switch (offset) {
|
2608 | 5c1c390f | balrog | case 0x00: /* SECONDS_REG */ |
2609 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2610 | 5c1c390f | balrog | printf("RTC SEC_REG <-- %02x\n", value);
|
2611 | 5c1c390f | balrog | #endif
|
2612 | 5c1c390f | balrog | s->ti -= s->current_tm.tm_sec; |
2613 | abd0c6bd | Paul Brook | s->ti += from_bcd(value); |
2614 | 5c1c390f | balrog | return;
|
2615 | 5c1c390f | balrog | |
2616 | 5c1c390f | balrog | case 0x04: /* MINUTES_REG */ |
2617 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2618 | 5c1c390f | balrog | printf("RTC MIN_REG <-- %02x\n", value);
|
2619 | 5c1c390f | balrog | #endif
|
2620 | 5c1c390f | balrog | s->ti -= s->current_tm.tm_min * 60;
|
2621 | abd0c6bd | Paul Brook | s->ti += from_bcd(value) * 60;
|
2622 | 5c1c390f | balrog | return;
|
2623 | 5c1c390f | balrog | |
2624 | 5c1c390f | balrog | case 0x08: /* HOURS_REG */ |
2625 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2626 | 5c1c390f | balrog | printf("RTC HRS_REG <-- %02x\n", value);
|
2627 | 5c1c390f | balrog | #endif
|
2628 | 5c1c390f | balrog | s->ti -= s->current_tm.tm_hour * 3600;
|
2629 | 5c1c390f | balrog | if (s->pm_am) {
|
2630 | abd0c6bd | Paul Brook | s->ti += (from_bcd(value & 0x3f) & 12) * 3600; |
2631 | 5c1c390f | balrog | s->ti += ((value >> 7) & 1) * 43200; |
2632 | 5c1c390f | balrog | } else
|
2633 | abd0c6bd | Paul Brook | s->ti += from_bcd(value & 0x3f) * 3600; |
2634 | 5c1c390f | balrog | return;
|
2635 | 5c1c390f | balrog | |
2636 | 5c1c390f | balrog | case 0x0c: /* DAYS_REG */ |
2637 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2638 | 5c1c390f | balrog | printf("RTC DAY_REG <-- %02x\n", value);
|
2639 | 5c1c390f | balrog | #endif
|
2640 | 5c1c390f | balrog | s->ti -= s->current_tm.tm_mday * 86400;
|
2641 | abd0c6bd | Paul Brook | s->ti += from_bcd(value) * 86400;
|
2642 | 5c1c390f | balrog | return;
|
2643 | 5c1c390f | balrog | |
2644 | 5c1c390f | balrog | case 0x10: /* MONTHS_REG */ |
2645 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2646 | 5c1c390f | balrog | printf("RTC MTH_REG <-- %02x\n", value);
|
2647 | 5c1c390f | balrog | #endif
|
2648 | 5c1c390f | balrog | memcpy(&new_tm, &s->current_tm, sizeof(new_tm));
|
2649 | abd0c6bd | Paul Brook | new_tm.tm_mon = from_bcd(value); |
2650 | 0cd2df75 | aurel32 | ti[0] = mktimegm(&s->current_tm);
|
2651 | 0cd2df75 | aurel32 | ti[1] = mktimegm(&new_tm);
|
2652 | 5c1c390f | balrog | |
2653 | 5c1c390f | balrog | if (ti[0] != -1 && ti[1] != -1) { |
2654 | 5c1c390f | balrog | s->ti -= ti[0];
|
2655 | 5c1c390f | balrog | s->ti += ti[1];
|
2656 | 5c1c390f | balrog | } else {
|
2657 | 5c1c390f | balrog | /* A less accurate version */
|
2658 | 5c1c390f | balrog | s->ti -= s->current_tm.tm_mon * 2592000;
|
2659 | abd0c6bd | Paul Brook | s->ti += from_bcd(value) * 2592000;
|
2660 | 5c1c390f | balrog | } |
2661 | 5c1c390f | balrog | return;
|
2662 | 5c1c390f | balrog | |
2663 | 5c1c390f | balrog | case 0x14: /* YEARS_REG */ |
2664 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2665 | 5c1c390f | balrog | printf("RTC YRS_REG <-- %02x\n", value);
|
2666 | 5c1c390f | balrog | #endif
|
2667 | 5c1c390f | balrog | memcpy(&new_tm, &s->current_tm, sizeof(new_tm));
|
2668 | abd0c6bd | Paul Brook | new_tm.tm_year += from_bcd(value) - (new_tm.tm_year % 100);
|
2669 | 0cd2df75 | aurel32 | ti[0] = mktimegm(&s->current_tm);
|
2670 | 0cd2df75 | aurel32 | ti[1] = mktimegm(&new_tm);
|
2671 | 5c1c390f | balrog | |
2672 | 5c1c390f | balrog | if (ti[0] != -1 && ti[1] != -1) { |
2673 | 5c1c390f | balrog | s->ti -= ti[0];
|
2674 | 5c1c390f | balrog | s->ti += ti[1];
|
2675 | 5c1c390f | balrog | } else {
|
2676 | 5c1c390f | balrog | /* A less accurate version */
|
2677 | 5c1c390f | balrog | s->ti -= (s->current_tm.tm_year % 100) * 31536000; |
2678 | abd0c6bd | Paul Brook | s->ti += from_bcd(value) * 31536000;
|
2679 | 5c1c390f | balrog | } |
2680 | 5c1c390f | balrog | return;
|
2681 | 5c1c390f | balrog | |
2682 | 5c1c390f | balrog | case 0x18: /* WEEK_REG */ |
2683 | 5c1c390f | balrog | return; /* Ignored */ |
2684 | 5c1c390f | balrog | |
2685 | 5c1c390f | balrog | case 0x20: /* ALARM_SECONDS_REG */ |
2686 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2687 | 5c1c390f | balrog | printf("ALM SEC_REG <-- %02x\n", value);
|
2688 | 5c1c390f | balrog | #endif
|
2689 | abd0c6bd | Paul Brook | s->alarm_tm.tm_sec = from_bcd(value); |
2690 | 5c1c390f | balrog | omap_rtc_alarm_update(s); |
2691 | 5c1c390f | balrog | return;
|
2692 | 5c1c390f | balrog | |
2693 | 5c1c390f | balrog | case 0x24: /* ALARM_MINUTES_REG */ |
2694 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2695 | 5c1c390f | balrog | printf("ALM MIN_REG <-- %02x\n", value);
|
2696 | 5c1c390f | balrog | #endif
|
2697 | abd0c6bd | Paul Brook | s->alarm_tm.tm_min = from_bcd(value); |
2698 | 5c1c390f | balrog | omap_rtc_alarm_update(s); |
2699 | 5c1c390f | balrog | return;
|
2700 | 5c1c390f | balrog | |
2701 | 5c1c390f | balrog | case 0x28: /* ALARM_HOURS_REG */ |
2702 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2703 | 5c1c390f | balrog | printf("ALM HRS_REG <-- %02x\n", value);
|
2704 | 5c1c390f | balrog | #endif
|
2705 | 5c1c390f | balrog | if (s->pm_am)
|
2706 | 5c1c390f | balrog | s->alarm_tm.tm_hour = |
2707 | abd0c6bd | Paul Brook | ((from_bcd(value & 0x3f)) % 12) + |
2708 | 5c1c390f | balrog | ((value >> 7) & 1) * 12; |
2709 | 5c1c390f | balrog | else
|
2710 | abd0c6bd | Paul Brook | s->alarm_tm.tm_hour = from_bcd(value); |
2711 | 5c1c390f | balrog | omap_rtc_alarm_update(s); |
2712 | 5c1c390f | balrog | return;
|
2713 | 5c1c390f | balrog | |
2714 | 5c1c390f | balrog | case 0x2c: /* ALARM_DAYS_REG */ |
2715 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2716 | 5c1c390f | balrog | printf("ALM DAY_REG <-- %02x\n", value);
|
2717 | 5c1c390f | balrog | #endif
|
2718 | abd0c6bd | Paul Brook | s->alarm_tm.tm_mday = from_bcd(value); |
2719 | 5c1c390f | balrog | omap_rtc_alarm_update(s); |
2720 | 5c1c390f | balrog | return;
|
2721 | 5c1c390f | balrog | |
2722 | 5c1c390f | balrog | case 0x30: /* ALARM_MONTHS_REG */ |
2723 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2724 | 5c1c390f | balrog | printf("ALM MON_REG <-- %02x\n", value);
|
2725 | 5c1c390f | balrog | #endif
|
2726 | abd0c6bd | Paul Brook | s->alarm_tm.tm_mon = from_bcd(value); |
2727 | 5c1c390f | balrog | omap_rtc_alarm_update(s); |
2728 | 5c1c390f | balrog | return;
|
2729 | 5c1c390f | balrog | |
2730 | 5c1c390f | balrog | case 0x34: /* ALARM_YEARS_REG */ |
2731 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2732 | 5c1c390f | balrog | printf("ALM YRS_REG <-- %02x\n", value);
|
2733 | 5c1c390f | balrog | #endif
|
2734 | abd0c6bd | Paul Brook | s->alarm_tm.tm_year = from_bcd(value); |
2735 | 5c1c390f | balrog | omap_rtc_alarm_update(s); |
2736 | 5c1c390f | balrog | return;
|
2737 | 5c1c390f | balrog | |
2738 | 5c1c390f | balrog | case 0x40: /* RTC_CTRL_REG */ |
2739 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2740 | 5c1c390f | balrog | printf("RTC CONTROL <-- %02x\n", value);
|
2741 | 5c1c390f | balrog | #endif
|
2742 | 5c1c390f | balrog | s->pm_am = (value >> 3) & 1; |
2743 | 5c1c390f | balrog | s->auto_comp = (value >> 2) & 1; |
2744 | 5c1c390f | balrog | s->round = (value >> 1) & 1; |
2745 | 5c1c390f | balrog | s->running = value & 1;
|
2746 | 5c1c390f | balrog | s->status &= 0xfd;
|
2747 | 5c1c390f | balrog | s->status |= s->running << 1;
|
2748 | 5c1c390f | balrog | return;
|
2749 | 5c1c390f | balrog | |
2750 | 5c1c390f | balrog | case 0x44: /* RTC_STATUS_REG */ |
2751 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2752 | 5c1c390f | balrog | printf("RTC STATUSL <-- %02x\n", value);
|
2753 | 5c1c390f | balrog | #endif
|
2754 | 5c1c390f | balrog | s->status &= ~((value & 0xc0) ^ 0x80); |
2755 | 5c1c390f | balrog | omap_rtc_interrupts_update(s); |
2756 | 5c1c390f | balrog | return;
|
2757 | 5c1c390f | balrog | |
2758 | 5c1c390f | balrog | case 0x48: /* RTC_INTERRUPTS_REG */ |
2759 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2760 | 5c1c390f | balrog | printf("RTC INTRS <-- %02x\n", value);
|
2761 | 5c1c390f | balrog | #endif
|
2762 | 5c1c390f | balrog | s->interrupts = value; |
2763 | 5c1c390f | balrog | return;
|
2764 | 5c1c390f | balrog | |
2765 | 5c1c390f | balrog | case 0x4c: /* RTC_COMP_LSB_REG */ |
2766 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2767 | 5c1c390f | balrog | printf("RTC COMPLSB <-- %02x\n", value);
|
2768 | 5c1c390f | balrog | #endif
|
2769 | 5c1c390f | balrog | s->comp_reg &= 0xff00;
|
2770 | 5c1c390f | balrog | s->comp_reg |= 0x00ff & value;
|
2771 | 5c1c390f | balrog | return;
|
2772 | 5c1c390f | balrog | |
2773 | 5c1c390f | balrog | case 0x50: /* RTC_COMP_MSB_REG */ |
2774 | eb38c52c | blueswir1 | #ifdef ALMDEBUG
|
2775 | 5c1c390f | balrog | printf("RTC COMPMSB <-- %02x\n", value);
|
2776 | 5c1c390f | balrog | #endif
|
2777 | 5c1c390f | balrog | s->comp_reg &= 0x00ff;
|
2778 | 5c1c390f | balrog | s->comp_reg |= 0xff00 & (value << 8); |
2779 | 5c1c390f | balrog | return;
|
2780 | 5c1c390f | balrog | |
2781 | 5c1c390f | balrog | default:
|
2782 | 5c1c390f | balrog | OMAP_BAD_REG(addr); |
2783 | 5c1c390f | balrog | return;
|
2784 | 5c1c390f | balrog | } |
2785 | 5c1c390f | balrog | } |
2786 | 5c1c390f | balrog | |
2787 | a4ebbd18 | Avi Kivity | static const MemoryRegionOps omap_rtc_ops = { |
2788 | a4ebbd18 | Avi Kivity | .read = omap_rtc_read, |
2789 | a4ebbd18 | Avi Kivity | .write = omap_rtc_write, |
2790 | a4ebbd18 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
2791 | 5c1c390f | balrog | }; |
2792 | 5c1c390f | balrog | |
2793 | 5c1c390f | balrog | static void omap_rtc_tick(void *opaque) |
2794 | 5c1c390f | balrog | { |
2795 | 5c1c390f | balrog | struct omap_rtc_s *s = opaque;
|
2796 | 5c1c390f | balrog | |
2797 | 5c1c390f | balrog | if (s->round) {
|
2798 | 5c1c390f | balrog | /* Round to nearest full minute. */
|
2799 | 5c1c390f | balrog | if (s->current_tm.tm_sec < 30) |
2800 | 5c1c390f | balrog | s->ti -= s->current_tm.tm_sec; |
2801 | 5c1c390f | balrog | else
|
2802 | 5c1c390f | balrog | s->ti += 60 - s->current_tm.tm_sec;
|
2803 | 5c1c390f | balrog | |
2804 | 5c1c390f | balrog | s->round = 0;
|
2805 | 5c1c390f | balrog | } |
2806 | 5c1c390f | balrog | |
2807 | f6503059 | balrog | memcpy(&s->current_tm, localtime(&s->ti), sizeof(s->current_tm));
|
2808 | 5c1c390f | balrog | |
2809 | 5c1c390f | balrog | if ((s->interrupts & 0x08) && s->ti == s->alarm_ti) { |
2810 | 5c1c390f | balrog | s->status |= 0x40;
|
2811 | 5c1c390f | balrog | omap_rtc_interrupts_update(s); |
2812 | 5c1c390f | balrog | } |
2813 | 5c1c390f | balrog | |
2814 | 5c1c390f | balrog | if (s->interrupts & 0x04) |
2815 | 5c1c390f | balrog | switch (s->interrupts & 3) { |
2816 | 5c1c390f | balrog | case 0: |
2817 | 5c1c390f | balrog | s->status |= 0x04;
|
2818 | 106627d0 | balrog | qemu_irq_pulse(s->irq); |
2819 | 5c1c390f | balrog | break;
|
2820 | 5c1c390f | balrog | case 1: |
2821 | 5c1c390f | balrog | if (s->current_tm.tm_sec)
|
2822 | 5c1c390f | balrog | break;
|
2823 | 5c1c390f | balrog | s->status |= 0x08;
|
2824 | 106627d0 | balrog | qemu_irq_pulse(s->irq); |
2825 | 5c1c390f | balrog | break;
|
2826 | 5c1c390f | balrog | case 2: |
2827 | 5c1c390f | balrog | if (s->current_tm.tm_sec || s->current_tm.tm_min)
|
2828 | 5c1c390f | balrog | break;
|
2829 | 5c1c390f | balrog | s->status |= 0x10;
|
2830 | 106627d0 | balrog | qemu_irq_pulse(s->irq); |
2831 | 5c1c390f | balrog | break;
|
2832 | 5c1c390f | balrog | case 3: |
2833 | 5c1c390f | balrog | if (s->current_tm.tm_sec ||
|
2834 | 5c1c390f | balrog | s->current_tm.tm_min || s->current_tm.tm_hour) |
2835 | 5c1c390f | balrog | break;
|
2836 | 5c1c390f | balrog | s->status |= 0x20;
|
2837 | 106627d0 | balrog | qemu_irq_pulse(s->irq); |
2838 | 5c1c390f | balrog | break;
|
2839 | 5c1c390f | balrog | } |
2840 | 5c1c390f | balrog | |
2841 | 5c1c390f | balrog | /* Move on */
|
2842 | 5c1c390f | balrog | if (s->running)
|
2843 | 5c1c390f | balrog | s->ti ++; |
2844 | 5c1c390f | balrog | s->tick += 1000;
|
2845 | 5c1c390f | balrog | |
2846 | 5c1c390f | balrog | /*
|
2847 | 5c1c390f | balrog | * Every full hour add a rough approximation of the compensation
|
2848 | 5c1c390f | balrog | * register to the 32kHz Timer (which drives the RTC) value.
|
2849 | 5c1c390f | balrog | */
|
2850 | 5c1c390f | balrog | if (s->auto_comp && !s->current_tm.tm_sec && !s->current_tm.tm_min)
|
2851 | 5c1c390f | balrog | s->tick += s->comp_reg * 1000 / 32768; |
2852 | 5c1c390f | balrog | |
2853 | 5c1c390f | balrog | qemu_mod_timer(s->clk, s->tick); |
2854 | 5c1c390f | balrog | } |
2855 | 5c1c390f | balrog | |
2856 | 9596ebb7 | pbrook | static void omap_rtc_reset(struct omap_rtc_s *s) |
2857 | 5c1c390f | balrog | { |
2858 | f6503059 | balrog | struct tm tm;
|
2859 | f6503059 | balrog | |
2860 | 5c1c390f | balrog | s->interrupts = 0;
|
2861 | 5c1c390f | balrog | s->comp_reg = 0;
|
2862 | 5c1c390f | balrog | s->running = 0;
|
2863 | 5c1c390f | balrog | s->pm_am = 0;
|
2864 | 5c1c390f | balrog | s->auto_comp = 0;
|
2865 | 5c1c390f | balrog | s->round = 0;
|
2866 | 7bd427d8 | Paolo Bonzini | s->tick = qemu_get_clock_ms(rt_clock); |
2867 | 5c1c390f | balrog | memset(&s->alarm_tm, 0, sizeof(s->alarm_tm)); |
2868 | 5c1c390f | balrog | s->alarm_tm.tm_mday = 0x01;
|
2869 | 5c1c390f | balrog | s->status = 1 << 7; |
2870 | f6503059 | balrog | qemu_get_timedate(&tm, 0);
|
2871 | 0cd2df75 | aurel32 | s->ti = mktimegm(&tm); |
2872 | 5c1c390f | balrog | |
2873 | 5c1c390f | balrog | omap_rtc_alarm_update(s); |
2874 | 5c1c390f | balrog | omap_rtc_tick(s); |
2875 | 5c1c390f | balrog | } |
2876 | 5c1c390f | balrog | |
2877 | a4ebbd18 | Avi Kivity | static struct omap_rtc_s *omap_rtc_init(MemoryRegion *system_memory, |
2878 | 0919ac78 | Peter Maydell | target_phys_addr_t base, |
2879 | 0919ac78 | Peter Maydell | qemu_irq timerirq, qemu_irq alarmirq, |
2880 | 0919ac78 | Peter Maydell | omap_clk clk) |
2881 | 5c1c390f | balrog | { |
2882 | 5c1c390f | balrog | struct omap_rtc_s *s = (struct omap_rtc_s *) |
2883 | 7267c094 | Anthony Liguori | g_malloc0(sizeof(struct omap_rtc_s)); |
2884 | 5c1c390f | balrog | |
2885 | 0919ac78 | Peter Maydell | s->irq = timerirq; |
2886 | 0919ac78 | Peter Maydell | s->alarm = alarmirq; |
2887 | 7bd427d8 | Paolo Bonzini | s->clk = qemu_new_timer_ms(rt_clock, omap_rtc_tick, s); |
2888 | 5c1c390f | balrog | |
2889 | 5c1c390f | balrog | omap_rtc_reset(s); |
2890 | 5c1c390f | balrog | |
2891 | a4ebbd18 | Avi Kivity | memory_region_init_io(&s->iomem, &omap_rtc_ops, s, |
2892 | a4ebbd18 | Avi Kivity | "omap-rtc", 0x800); |
2893 | a4ebbd18 | Avi Kivity | memory_region_add_subregion(system_memory, base, &s->iomem); |
2894 | 5c1c390f | balrog | |
2895 | 5c1c390f | balrog | return s;
|
2896 | 5c1c390f | balrog | } |
2897 | 5c1c390f | balrog | |
2898 | d8f699cb | balrog | /* Multi-channel Buffered Serial Port interfaces */
|
2899 | d8f699cb | balrog | struct omap_mcbsp_s {
|
2900 | a4ebbd18 | Avi Kivity | MemoryRegion iomem; |
2901 | d8f699cb | balrog | qemu_irq txirq; |
2902 | d8f699cb | balrog | qemu_irq rxirq; |
2903 | d8f699cb | balrog | qemu_irq txdrq; |
2904 | d8f699cb | balrog | qemu_irq rxdrq; |
2905 | d8f699cb | balrog | |
2906 | d8f699cb | balrog | uint16_t spcr[2];
|
2907 | d8f699cb | balrog | uint16_t rcr[2];
|
2908 | d8f699cb | balrog | uint16_t xcr[2];
|
2909 | d8f699cb | balrog | uint16_t srgr[2];
|
2910 | d8f699cb | balrog | uint16_t mcr[2];
|
2911 | d8f699cb | balrog | uint16_t pcr; |
2912 | d8f699cb | balrog | uint16_t rcer[8];
|
2913 | d8f699cb | balrog | uint16_t xcer[8];
|
2914 | d8f699cb | balrog | int tx_rate;
|
2915 | d8f699cb | balrog | int rx_rate;
|
2916 | d8f699cb | balrog | int tx_req;
|
2917 | 73560bc8 | balrog | int rx_req;
|
2918 | d8f699cb | balrog | |
2919 | bc24a225 | Paul Brook | I2SCodec *codec; |
2920 | 73560bc8 | balrog | QEMUTimer *source_timer; |
2921 | 73560bc8 | balrog | QEMUTimer *sink_timer; |
2922 | d8f699cb | balrog | }; |
2923 | d8f699cb | balrog | |
2924 | d8f699cb | balrog | static void omap_mcbsp_intr_update(struct omap_mcbsp_s *s) |
2925 | d8f699cb | balrog | { |
2926 | d8f699cb | balrog | int irq;
|
2927 | d8f699cb | balrog | |
2928 | d8f699cb | balrog | switch ((s->spcr[0] >> 4) & 3) { /* RINTM */ |
2929 | d8f699cb | balrog | case 0: |
2930 | d8f699cb | balrog | irq = (s->spcr[0] >> 1) & 1; /* RRDY */ |
2931 | d8f699cb | balrog | break;
|
2932 | d8f699cb | balrog | case 3: |
2933 | d8f699cb | balrog | irq = (s->spcr[0] >> 3) & 1; /* RSYNCERR */ |
2934 | d8f699cb | balrog | break;
|
2935 | d8f699cb | balrog | default:
|
2936 | d8f699cb | balrog | irq = 0;
|
2937 | d8f699cb | balrog | break;
|
2938 | d8f699cb | balrog | } |
2939 | d8f699cb | balrog | |
2940 | 106627d0 | balrog | if (irq)
|
2941 | 106627d0 | balrog | qemu_irq_pulse(s->rxirq); |
2942 | d8f699cb | balrog | |
2943 | d8f699cb | balrog | switch ((s->spcr[1] >> 4) & 3) { /* XINTM */ |
2944 | d8f699cb | balrog | case 0: |
2945 | d8f699cb | balrog | irq = (s->spcr[1] >> 1) & 1; /* XRDY */ |
2946 | d8f699cb | balrog | break;
|
2947 | d8f699cb | balrog | case 3: |
2948 | d8f699cb | balrog | irq = (s->spcr[1] >> 3) & 1; /* XSYNCERR */ |
2949 | d8f699cb | balrog | break;
|
2950 | d8f699cb | balrog | default:
|
2951 | d8f699cb | balrog | irq = 0;
|
2952 | d8f699cb | balrog | break;
|
2953 | d8f699cb | balrog | } |
2954 | d8f699cb | balrog | |
2955 | 106627d0 | balrog | if (irq)
|
2956 | 106627d0 | balrog | qemu_irq_pulse(s->txirq); |
2957 | d8f699cb | balrog | } |
2958 | d8f699cb | balrog | |
2959 | 73560bc8 | balrog | static void omap_mcbsp_rx_newdata(struct omap_mcbsp_s *s) |
2960 | d8f699cb | balrog | { |
2961 | 73560bc8 | balrog | if ((s->spcr[0] >> 1) & 1) /* RRDY */ |
2962 | 73560bc8 | balrog | s->spcr[0] |= 1 << 2; /* RFULL */ |
2963 | 73560bc8 | balrog | s->spcr[0] |= 1 << 1; /* RRDY */ |
2964 | 73560bc8 | balrog | qemu_irq_raise(s->rxdrq); |
2965 | 73560bc8 | balrog | omap_mcbsp_intr_update(s); |
2966 | d8f699cb | balrog | } |
2967 | d8f699cb | balrog | |
2968 | 73560bc8 | balrog | static void omap_mcbsp_source_tick(void *opaque) |
2969 | d8f699cb | balrog | { |
2970 | 73560bc8 | balrog | struct omap_mcbsp_s *s = (struct omap_mcbsp_s *) opaque; |
2971 | 73560bc8 | balrog | static const int bps[8] = { 0, 1, 1, 2, 2, 2, -255, -255 }; |
2972 | 73560bc8 | balrog | |
2973 | 73560bc8 | balrog | if (!s->rx_rate)
|
2974 | d8f699cb | balrog | return;
|
2975 | 73560bc8 | balrog | if (s->rx_req)
|
2976 | 73560bc8 | balrog | printf("%s: Rx FIFO overrun\n", __FUNCTION__);
|
2977 | d8f699cb | balrog | |
2978 | 73560bc8 | balrog | s->rx_req = s->rx_rate << bps[(s->rcr[0] >> 5) & 7]; |
2979 | d8f699cb | balrog | |
2980 | 73560bc8 | balrog | omap_mcbsp_rx_newdata(s); |
2981 | 74475455 | Paolo Bonzini | qemu_mod_timer(s->source_timer, qemu_get_clock_ns(vm_clock) + |
2982 | 6ee093c9 | Juan Quintela | get_ticks_per_sec()); |
2983 | d8f699cb | balrog | } |
2984 | d8f699cb | balrog | |
2985 | d8f699cb | balrog | static void omap_mcbsp_rx_start(struct omap_mcbsp_s *s) |
2986 | d8f699cb | balrog | { |
2987 | 73560bc8 | balrog | if (!s->codec || !s->codec->rts)
|
2988 | 73560bc8 | balrog | omap_mcbsp_source_tick(s); |
2989 | 73560bc8 | balrog | else if (s->codec->in.len) { |
2990 | 73560bc8 | balrog | s->rx_req = s->codec->in.len; |
2991 | 73560bc8 | balrog | omap_mcbsp_rx_newdata(s); |
2992 | d8f699cb | balrog | } |
2993 | d8f699cb | balrog | } |
2994 | d8f699cb | balrog | |
2995 | d8f699cb | balrog | static void omap_mcbsp_rx_stop(struct omap_mcbsp_s *s) |
2996 | d8f699cb | balrog | { |
2997 | 73560bc8 | balrog | qemu_del_timer(s->source_timer); |
2998 | 73560bc8 | balrog | } |
2999 | 73560bc8 | balrog | |
3000 | 73560bc8 | balrog | static void omap_mcbsp_rx_done(struct omap_mcbsp_s *s) |
3001 | 73560bc8 | balrog | { |
3002 | d8f699cb | balrog | s->spcr[0] &= ~(1 << 1); /* RRDY */ |
3003 | d8f699cb | balrog | qemu_irq_lower(s->rxdrq); |
3004 | d8f699cb | balrog | omap_mcbsp_intr_update(s); |
3005 | d8f699cb | balrog | } |
3006 | d8f699cb | balrog | |
3007 | 73560bc8 | balrog | static void omap_mcbsp_tx_newdata(struct omap_mcbsp_s *s) |
3008 | 73560bc8 | balrog | { |
3009 | 73560bc8 | balrog | s->spcr[1] |= 1 << 1; /* XRDY */ |
3010 | 73560bc8 | balrog | qemu_irq_raise(s->txdrq); |
3011 | 73560bc8 | balrog | omap_mcbsp_intr_update(s); |
3012 | 73560bc8 | balrog | } |
3013 | 73560bc8 | balrog | |
3014 | 73560bc8 | balrog | static void omap_mcbsp_sink_tick(void *opaque) |
3015 | d8f699cb | balrog | { |
3016 | 73560bc8 | balrog | struct omap_mcbsp_s *s = (struct omap_mcbsp_s *) opaque; |
3017 | 73560bc8 | balrog | static const int bps[8] = { 0, 1, 1, 2, 2, 2, -255, -255 }; |
3018 | 73560bc8 | balrog | |
3019 | 73560bc8 | balrog | if (!s->tx_rate)
|
3020 | d8f699cb | balrog | return;
|
3021 | 73560bc8 | balrog | if (s->tx_req)
|
3022 | 73560bc8 | balrog | printf("%s: Tx FIFO underrun\n", __FUNCTION__);
|
3023 | 73560bc8 | balrog | |
3024 | 73560bc8 | balrog | s->tx_req = s->tx_rate << bps[(s->xcr[0] >> 5) & 7]; |
3025 | 73560bc8 | balrog | |
3026 | 73560bc8 | balrog | omap_mcbsp_tx_newdata(s); |
3027 | 74475455 | Paolo Bonzini | qemu_mod_timer(s->sink_timer, qemu_get_clock_ns(vm_clock) + |
3028 | 6ee093c9 | Juan Quintela | get_ticks_per_sec()); |
3029 | 73560bc8 | balrog | } |
3030 | 73560bc8 | balrog | |
3031 | 73560bc8 | balrog | static void omap_mcbsp_tx_start(struct omap_mcbsp_s *s) |
3032 | 73560bc8 | balrog | { |
3033 | 73560bc8 | balrog | if (!s->codec || !s->codec->cts)
|
3034 | 73560bc8 | balrog | omap_mcbsp_sink_tick(s); |
3035 | 73560bc8 | balrog | else if (s->codec->out.size) { |
3036 | 73560bc8 | balrog | s->tx_req = s->codec->out.size; |
3037 | 73560bc8 | balrog | omap_mcbsp_tx_newdata(s); |
3038 | 73560bc8 | balrog | } |
3039 | 73560bc8 | balrog | } |
3040 | 73560bc8 | balrog | |
3041 | 73560bc8 | balrog | static void omap_mcbsp_tx_done(struct omap_mcbsp_s *s) |
3042 | 73560bc8 | balrog | { |
3043 | 73560bc8 | balrog | s->spcr[1] &= ~(1 << 1); /* XRDY */ |
3044 | 73560bc8 | balrog | qemu_irq_lower(s->txdrq); |
3045 | 73560bc8 | balrog | omap_mcbsp_intr_update(s); |
3046 | 73560bc8 | balrog | if (s->codec && s->codec->cts)
|
3047 | 73560bc8 | balrog | s->codec->tx_swallow(s->codec->opaque); |
3048 | d8f699cb | balrog | } |
3049 | d8f699cb | balrog | |
3050 | d8f699cb | balrog | static void omap_mcbsp_tx_stop(struct omap_mcbsp_s *s) |
3051 | d8f699cb | balrog | { |
3052 | 73560bc8 | balrog | s->tx_req = 0;
|
3053 | 73560bc8 | balrog | omap_mcbsp_tx_done(s); |
3054 | 73560bc8 | balrog | qemu_del_timer(s->sink_timer); |
3055 | 73560bc8 | balrog | } |
3056 | 73560bc8 | balrog | |
3057 | 73560bc8 | balrog | static void omap_mcbsp_req_update(struct omap_mcbsp_s *s) |
3058 | 73560bc8 | balrog | { |
3059 | 73560bc8 | balrog | int prev_rx_rate, prev_tx_rate;
|
3060 | 73560bc8 | balrog | int rx_rate = 0, tx_rate = 0; |
3061 | 73560bc8 | balrog | int cpu_rate = 1500000; /* XXX */ |
3062 | 73560bc8 | balrog | |
3063 | 73560bc8 | balrog | /* TODO: check CLKSTP bit */
|
3064 | 73560bc8 | balrog | if (s->spcr[1] & (1 << 6)) { /* GRST */ |
3065 | 73560bc8 | balrog | if (s->spcr[0] & (1 << 0)) { /* RRST */ |
3066 | 73560bc8 | balrog | if ((s->srgr[1] & (1 << 13)) && /* CLKSM */ |
3067 | 73560bc8 | balrog | (s->pcr & (1 << 8))) { /* CLKRM */ |
3068 | 73560bc8 | balrog | if (~s->pcr & (1 << 7)) /* SCLKME */ |
3069 | 73560bc8 | balrog | rx_rate = cpu_rate / |
3070 | 73560bc8 | balrog | ((s->srgr[0] & 0xff) + 1); /* CLKGDV */ |
3071 | 73560bc8 | balrog | } else
|
3072 | 73560bc8 | balrog | if (s->codec)
|
3073 | 73560bc8 | balrog | rx_rate = s->codec->rx_rate; |
3074 | 73560bc8 | balrog | } |
3075 | 73560bc8 | balrog | |
3076 | 73560bc8 | balrog | if (s->spcr[1] & (1 << 0)) { /* XRST */ |
3077 | 73560bc8 | balrog | if ((s->srgr[1] & (1 << 13)) && /* CLKSM */ |
3078 | 73560bc8 | balrog | (s->pcr & (1 << 9))) { /* CLKXM */ |
3079 | 73560bc8 | balrog | if (~s->pcr & (1 << 7)) /* SCLKME */ |
3080 | 73560bc8 | balrog | tx_rate = cpu_rate / |
3081 | 73560bc8 | balrog | ((s->srgr[0] & 0xff) + 1); /* CLKGDV */ |
3082 | 73560bc8 | balrog | } else
|
3083 | 73560bc8 | balrog | if (s->codec)
|
3084 | 73560bc8 | balrog | tx_rate = s->codec->tx_rate; |
3085 | 73560bc8 | balrog | } |
3086 | 73560bc8 | balrog | } |
3087 | 73560bc8 | balrog | prev_tx_rate = s->tx_rate; |
3088 | 73560bc8 | balrog | prev_rx_rate = s->rx_rate; |
3089 | 73560bc8 | balrog | s->tx_rate = tx_rate; |
3090 | 73560bc8 | balrog | s->rx_rate = rx_rate; |
3091 | 73560bc8 | balrog | |
3092 | 73560bc8 | balrog | if (s->codec)
|
3093 | 73560bc8 | balrog | s->codec->set_rate(s->codec->opaque, rx_rate, tx_rate); |
3094 | 73560bc8 | balrog | |
3095 | 73560bc8 | balrog | if (!prev_tx_rate && tx_rate)
|
3096 | 73560bc8 | balrog | omap_mcbsp_tx_start(s); |
3097 | 73560bc8 | balrog | else if (s->tx_rate && !tx_rate) |
3098 | 73560bc8 | balrog | omap_mcbsp_tx_stop(s); |
3099 | 73560bc8 | balrog | |
3100 | 73560bc8 | balrog | if (!prev_rx_rate && rx_rate)
|
3101 | 73560bc8 | balrog | omap_mcbsp_rx_start(s); |
3102 | 73560bc8 | balrog | else if (prev_tx_rate && !tx_rate) |
3103 | 73560bc8 | balrog | omap_mcbsp_rx_stop(s); |
3104 | d8f699cb | balrog | } |
3105 | d8f699cb | balrog | |
3106 | a4ebbd18 | Avi Kivity | static uint64_t omap_mcbsp_read(void *opaque, target_phys_addr_t addr, |
3107 | a4ebbd18 | Avi Kivity | unsigned size)
|
3108 | d8f699cb | balrog | { |
3109 | d8f699cb | balrog | struct omap_mcbsp_s *s = (struct omap_mcbsp_s *) opaque; |
3110 | d8f699cb | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
3111 | d8f699cb | balrog | uint16_t ret; |
3112 | d8f699cb | balrog | |
3113 | a4ebbd18 | Avi Kivity | if (size != 2) { |
3114 | a4ebbd18 | Avi Kivity | return omap_badwidth_read16(opaque, addr);
|
3115 | a4ebbd18 | Avi Kivity | } |
3116 | a4ebbd18 | Avi Kivity | |
3117 | d8f699cb | balrog | switch (offset) {
|
3118 | d8f699cb | balrog | case 0x00: /* DRR2 */ |
3119 | d8f699cb | balrog | if (((s->rcr[0] >> 5) & 7) < 3) /* RWDLEN1 */ |
3120 | d8f699cb | balrog | return 0x0000; |
3121 | d8f699cb | balrog | /* Fall through. */
|
3122 | d8f699cb | balrog | case 0x02: /* DRR1 */ |
3123 | 73560bc8 | balrog | if (s->rx_req < 2) { |
3124 | d8f699cb | balrog | printf("%s: Rx FIFO underrun\n", __FUNCTION__);
|
3125 | 73560bc8 | balrog | omap_mcbsp_rx_done(s); |
3126 | d8f699cb | balrog | } else {
|
3127 | 73560bc8 | balrog | s->tx_req -= 2;
|
3128 | 73560bc8 | balrog | if (s->codec && s->codec->in.len >= 2) { |
3129 | 73560bc8 | balrog | ret = s->codec->in.fifo[s->codec->in.start ++] << 8;
|
3130 | 73560bc8 | balrog | ret |= s->codec->in.fifo[s->codec->in.start ++]; |
3131 | 73560bc8 | balrog | s->codec->in.len -= 2;
|
3132 | 73560bc8 | balrog | } else
|
3133 | 73560bc8 | balrog | ret = 0x0000;
|
3134 | 73560bc8 | balrog | if (!s->tx_req)
|
3135 | 73560bc8 | balrog | omap_mcbsp_rx_done(s); |
3136 | d8f699cb | balrog | return ret;
|
3137 | d8f699cb | balrog | } |
3138 | d8f699cb | balrog | return 0x0000; |
3139 | d8f699cb | balrog | |
3140 | d8f699cb | balrog | case 0x04: /* DXR2 */ |
3141 | d8f699cb | balrog | case 0x06: /* DXR1 */ |
3142 | d8f699cb | balrog | return 0x0000; |
3143 | d8f699cb | balrog | |
3144 | d8f699cb | balrog | case 0x08: /* SPCR2 */ |
3145 | d8f699cb | balrog | return s->spcr[1]; |
3146 | d8f699cb | balrog | case 0x0a: /* SPCR1 */ |
3147 | d8f699cb | balrog | return s->spcr[0]; |
3148 | d8f699cb | balrog | case 0x0c: /* RCR2 */ |
3149 | d8f699cb | balrog | return s->rcr[1]; |
3150 | d8f699cb | balrog | case 0x0e: /* RCR1 */ |
3151 | d8f699cb | balrog | return s->rcr[0]; |
3152 | d8f699cb | balrog | case 0x10: /* XCR2 */ |
3153 | d8f699cb | balrog | return s->xcr[1]; |
3154 | d8f699cb | balrog | case 0x12: /* XCR1 */ |
3155 | d8f699cb | balrog | return s->xcr[0]; |
3156 | d8f699cb | balrog | case 0x14: /* SRGR2 */ |
3157 | d8f699cb | balrog | return s->srgr[1]; |
3158 | d8f699cb | balrog | case 0x16: /* SRGR1 */ |
3159 | d8f699cb | balrog | return s->srgr[0]; |
3160 | d8f699cb | balrog | case 0x18: /* MCR2 */ |
3161 | d8f699cb | balrog | return s->mcr[1]; |
3162 | d8f699cb | balrog | case 0x1a: /* MCR1 */ |
3163 | d8f699cb | balrog | return s->mcr[0]; |
3164 | d8f699cb | balrog | case 0x1c: /* RCERA */ |
3165 | d8f699cb | balrog | return s->rcer[0]; |
3166 | d8f699cb | balrog | case 0x1e: /* RCERB */ |
3167 | d8f699cb | balrog | return s->rcer[1]; |
3168 | d8f699cb | balrog | case 0x20: /* XCERA */ |
3169 | d8f699cb | balrog | return s->xcer[0]; |
3170 | d8f699cb | balrog | case 0x22: /* XCERB */ |
3171 | d8f699cb | balrog | return s->xcer[1]; |
3172 | d8f699cb | balrog | case 0x24: /* PCR0 */ |
3173 | d8f699cb | balrog | return s->pcr;
|
3174 | d8f699cb | balrog | case 0x26: /* RCERC */ |
3175 | d8f699cb | balrog | return s->rcer[2]; |
3176 | d8f699cb | balrog | case 0x28: /* RCERD */ |
3177 | d8f699cb | balrog | return s->rcer[3]; |
3178 | d8f699cb | balrog | case 0x2a: /* XCERC */ |
3179 | d8f699cb | balrog | return s->xcer[2]; |
3180 | d8f699cb | balrog | case 0x2c: /* XCERD */ |
3181 | d8f699cb | balrog | return s->xcer[3]; |
3182 | d8f699cb | balrog | case 0x2e: /* RCERE */ |
3183 | d8f699cb | balrog | return s->rcer[4]; |
3184 | d8f699cb | balrog | case 0x30: /* RCERF */ |
3185 | d8f699cb | balrog | return s->rcer[5]; |
3186 | d8f699cb | balrog | case 0x32: /* XCERE */ |
3187 | d8f699cb | balrog | return s->xcer[4]; |
3188 | d8f699cb | balrog | case 0x34: /* XCERF */ |
3189 | d8f699cb | balrog | return s->xcer[5]; |
3190 | d8f699cb | balrog | case 0x36: /* RCERG */ |
3191 | d8f699cb | balrog | return s->rcer[6]; |
3192 | d8f699cb | balrog | case 0x38: /* RCERH */ |
3193 | d8f699cb | balrog | return s->rcer[7]; |
3194 | d8f699cb | balrog | case 0x3a: /* XCERG */ |
3195 | d8f699cb | balrog | return s->xcer[6]; |
3196 | d8f699cb | balrog | case 0x3c: /* XCERH */ |
3197 | d8f699cb | balrog | return s->xcer[7]; |
3198 | d8f699cb | balrog | } |
3199 | d8f699cb | balrog | |
3200 | d8f699cb | balrog | OMAP_BAD_REG(addr); |
3201 | d8f699cb | balrog | return 0; |
3202 | d8f699cb | balrog | } |
3203 | d8f699cb | balrog | |
3204 | c227f099 | Anthony Liguori | static void omap_mcbsp_writeh(void *opaque, target_phys_addr_t addr, |
3205 | d8f699cb | balrog | uint32_t value) |
3206 | d8f699cb | balrog | { |
3207 | d8f699cb | balrog | struct omap_mcbsp_s *s = (struct omap_mcbsp_s *) opaque; |
3208 | d8f699cb | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
3209 | d8f699cb | balrog | |
3210 | d8f699cb | balrog | switch (offset) {
|
3211 | d8f699cb | balrog | case 0x00: /* DRR2 */ |
3212 | d8f699cb | balrog | case 0x02: /* DRR1 */ |
3213 | d8f699cb | balrog | OMAP_RO_REG(addr); |
3214 | d8f699cb | balrog | return;
|
3215 | d8f699cb | balrog | |
3216 | d8f699cb | balrog | case 0x04: /* DXR2 */ |
3217 | d8f699cb | balrog | if (((s->xcr[0] >> 5) & 7) < 3) /* XWDLEN1 */ |
3218 | d8f699cb | balrog | return;
|
3219 | d8f699cb | balrog | /* Fall through. */
|
3220 | d8f699cb | balrog | case 0x06: /* DXR1 */ |
3221 | 73560bc8 | balrog | if (s->tx_req > 1) { |
3222 | 73560bc8 | balrog | s->tx_req -= 2;
|
3223 | 73560bc8 | balrog | if (s->codec && s->codec->cts) {
|
3224 | d8f699cb | balrog | s->codec->out.fifo[s->codec->out.len ++] = (value >> 8) & 0xff; |
3225 | d8f699cb | balrog | s->codec->out.fifo[s->codec->out.len ++] = (value >> 0) & 0xff; |
3226 | d8f699cb | balrog | } |
3227 | 73560bc8 | balrog | if (s->tx_req < 2) |
3228 | 73560bc8 | balrog | omap_mcbsp_tx_done(s); |
3229 | d8f699cb | balrog | } else
|
3230 | d8f699cb | balrog | printf("%s: Tx FIFO overrun\n", __FUNCTION__);
|
3231 | d8f699cb | balrog | return;
|
3232 | d8f699cb | balrog | |
3233 | d8f699cb | balrog | case 0x08: /* SPCR2 */ |
3234 | d8f699cb | balrog | s->spcr[1] &= 0x0002; |
3235 | d8f699cb | balrog | s->spcr[1] |= 0x03f9 & value; |
3236 | d8f699cb | balrog | s->spcr[1] |= 0x0004 & (value << 2); /* XEMPTY := XRST */ |
3237 | 73560bc8 | balrog | if (~value & 1) /* XRST */ |
3238 | d8f699cb | balrog | s->spcr[1] &= ~6; |
3239 | d8f699cb | balrog | omap_mcbsp_req_update(s); |
3240 | d8f699cb | balrog | return;
|
3241 | d8f699cb | balrog | case 0x0a: /* SPCR1 */ |
3242 | d8f699cb | balrog | s->spcr[0] &= 0x0006; |
3243 | d8f699cb | balrog | s->spcr[0] |= 0xf8f9 & value; |
3244 | d8f699cb | balrog | if (value & (1 << 15)) /* DLB */ |
3245 | d8f699cb | balrog | printf("%s: Digital Loopback mode enable attempt\n", __FUNCTION__);
|
3246 | d8f699cb | balrog | if (~value & 1) { /* RRST */ |
3247 | d8f699cb | balrog | s->spcr[0] &= ~6; |
3248 | 73560bc8 | balrog | s->rx_req = 0;
|
3249 | 73560bc8 | balrog | omap_mcbsp_rx_done(s); |
3250 | d8f699cb | balrog | } |
3251 | d8f699cb | balrog | omap_mcbsp_req_update(s); |
3252 | d8f699cb | balrog | return;
|
3253 | d8f699cb | balrog | |
3254 | d8f699cb | balrog | case 0x0c: /* RCR2 */ |
3255 | d8f699cb | balrog | s->rcr[1] = value & 0xffff; |
3256 | d8f699cb | balrog | return;
|
3257 | d8f699cb | balrog | case 0x0e: /* RCR1 */ |
3258 | d8f699cb | balrog | s->rcr[0] = value & 0x7fe0; |
3259 | d8f699cb | balrog | return;
|
3260 | d8f699cb | balrog | case 0x10: /* XCR2 */ |
3261 | d8f699cb | balrog | s->xcr[1] = value & 0xffff; |
3262 | d8f699cb | balrog | return;
|
3263 | d8f699cb | balrog | case 0x12: /* XCR1 */ |
3264 | d8f699cb | balrog | s->xcr[0] = value & 0x7fe0; |
3265 | d8f699cb | balrog | return;
|
3266 | d8f699cb | balrog | case 0x14: /* SRGR2 */ |
3267 | d8f699cb | balrog | s->srgr[1] = value & 0xffff; |
3268 | 73560bc8 | balrog | omap_mcbsp_req_update(s); |
3269 | d8f699cb | balrog | return;
|
3270 | d8f699cb | balrog | case 0x16: /* SRGR1 */ |
3271 | d8f699cb | balrog | s->srgr[0] = value & 0xffff; |
3272 | 73560bc8 | balrog | omap_mcbsp_req_update(s); |
3273 | d8f699cb | balrog | return;
|
3274 | d8f699cb | balrog | case 0x18: /* MCR2 */ |
3275 | d8f699cb | balrog | s->mcr[1] = value & 0x03e3; |
3276 | d8f699cb | balrog | if (value & 3) /* XMCM */ |
3277 | d8f699cb | balrog | printf("%s: Tx channel selection mode enable attempt\n",
|
3278 | d8f699cb | balrog | __FUNCTION__); |
3279 | d8f699cb | balrog | return;
|
3280 | d8f699cb | balrog | case 0x1a: /* MCR1 */ |
3281 | d8f699cb | balrog | s->mcr[0] = value & 0x03e1; |
3282 | d8f699cb | balrog | if (value & 1) /* RMCM */ |
3283 | d8f699cb | balrog | printf("%s: Rx channel selection mode enable attempt\n",
|
3284 | d8f699cb | balrog | __FUNCTION__); |
3285 | d8f699cb | balrog | return;
|
3286 | d8f699cb | balrog | case 0x1c: /* RCERA */ |
3287 | d8f699cb | balrog | s->rcer[0] = value & 0xffff; |
3288 | d8f699cb | balrog | return;
|
3289 | d8f699cb | balrog | case 0x1e: /* RCERB */ |
3290 | d8f699cb | balrog | s->rcer[1] = value & 0xffff; |
3291 | d8f699cb | balrog | return;
|
3292 | d8f699cb | balrog | case 0x20: /* XCERA */ |
3293 | d8f699cb | balrog | s->xcer[0] = value & 0xffff; |
3294 | d8f699cb | balrog | return;
|
3295 | d8f699cb | balrog | case 0x22: /* XCERB */ |
3296 | d8f699cb | balrog | s->xcer[1] = value & 0xffff; |
3297 | d8f699cb | balrog | return;
|
3298 | d8f699cb | balrog | case 0x24: /* PCR0 */ |
3299 | d8f699cb | balrog | s->pcr = value & 0x7faf;
|
3300 | d8f699cb | balrog | return;
|
3301 | d8f699cb | balrog | case 0x26: /* RCERC */ |
3302 | d8f699cb | balrog | s->rcer[2] = value & 0xffff; |
3303 | d8f699cb | balrog | return;
|
3304 | d8f699cb | balrog | case 0x28: /* RCERD */ |
3305 | d8f699cb | balrog | s->rcer[3] = value & 0xffff; |
3306 | d8f699cb | balrog | return;
|
3307 | d8f699cb | balrog | case 0x2a: /* XCERC */ |
3308 | d8f699cb | balrog | s->xcer[2] = value & 0xffff; |
3309 | d8f699cb | balrog | return;
|
3310 | d8f699cb | balrog | case 0x2c: /* XCERD */ |
3311 | d8f699cb | balrog | s->xcer[3] = value & 0xffff; |
3312 | d8f699cb | balrog | return;
|
3313 | d8f699cb | balrog | case 0x2e: /* RCERE */ |
3314 | d8f699cb | balrog | s->rcer[4] = value & 0xffff; |
3315 | d8f699cb | balrog | return;
|
3316 | d8f699cb | balrog | case 0x30: /* RCERF */ |
3317 | d8f699cb | balrog | s->rcer[5] = value & 0xffff; |
3318 | d8f699cb | balrog | return;
|
3319 | d8f699cb | balrog | case 0x32: /* XCERE */ |
3320 | d8f699cb | balrog | s->xcer[4] = value & 0xffff; |
3321 | d8f699cb | balrog | return;
|
3322 | d8f699cb | balrog | case 0x34: /* XCERF */ |
3323 | d8f699cb | balrog | s->xcer[5] = value & 0xffff; |
3324 | d8f699cb | balrog | return;
|
3325 | d8f699cb | balrog | case 0x36: /* RCERG */ |
3326 | d8f699cb | balrog | s->rcer[6] = value & 0xffff; |
3327 | d8f699cb | balrog | return;
|
3328 | d8f699cb | balrog | case 0x38: /* RCERH */ |
3329 | d8f699cb | balrog | s->rcer[7] = value & 0xffff; |
3330 | d8f699cb | balrog | return;
|
3331 | d8f699cb | balrog | case 0x3a: /* XCERG */ |
3332 | d8f699cb | balrog | s->xcer[6] = value & 0xffff; |
3333 | d8f699cb | balrog | return;
|
3334 | d8f699cb | balrog | case 0x3c: /* XCERH */ |
3335 | d8f699cb | balrog | s->xcer[7] = value & 0xffff; |
3336 | d8f699cb | balrog | return;
|
3337 | d8f699cb | balrog | } |
3338 | d8f699cb | balrog | |
3339 | d8f699cb | balrog | OMAP_BAD_REG(addr); |
3340 | d8f699cb | balrog | } |
3341 | d8f699cb | balrog | |
3342 | c227f099 | Anthony Liguori | static void omap_mcbsp_writew(void *opaque, target_phys_addr_t addr, |
3343 | 73560bc8 | balrog | uint32_t value) |
3344 | 73560bc8 | balrog | { |
3345 | 73560bc8 | balrog | struct omap_mcbsp_s *s = (struct omap_mcbsp_s *) opaque; |
3346 | 73560bc8 | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
3347 | 73560bc8 | balrog | |
3348 | 73560bc8 | balrog | if (offset == 0x04) { /* DXR */ |
3349 | 73560bc8 | balrog | if (((s->xcr[0] >> 5) & 7) < 3) /* XWDLEN1 */ |
3350 | 73560bc8 | balrog | return;
|
3351 | 73560bc8 | balrog | if (s->tx_req > 3) { |
3352 | 73560bc8 | balrog | s->tx_req -= 4;
|
3353 | 73560bc8 | balrog | if (s->codec && s->codec->cts) {
|
3354 | 73560bc8 | balrog | s->codec->out.fifo[s->codec->out.len ++] = |
3355 | 73560bc8 | balrog | (value >> 24) & 0xff; |
3356 | 73560bc8 | balrog | s->codec->out.fifo[s->codec->out.len ++] = |
3357 | 73560bc8 | balrog | (value >> 16) & 0xff; |
3358 | 73560bc8 | balrog | s->codec->out.fifo[s->codec->out.len ++] = |
3359 | 73560bc8 | balrog | (value >> 8) & 0xff; |
3360 | 73560bc8 | balrog | s->codec->out.fifo[s->codec->out.len ++] = |
3361 | 73560bc8 | balrog | (value >> 0) & 0xff; |
3362 | 73560bc8 | balrog | } |
3363 | 73560bc8 | balrog | if (s->tx_req < 4) |
3364 | 73560bc8 | balrog | omap_mcbsp_tx_done(s); |
3365 | 73560bc8 | balrog | } else
|
3366 | 73560bc8 | balrog | printf("%s: Tx FIFO overrun\n", __FUNCTION__);
|
3367 | 73560bc8 | balrog | return;
|
3368 | 73560bc8 | balrog | } |
3369 | 73560bc8 | balrog | |
3370 | 73560bc8 | balrog | omap_badwidth_write16(opaque, addr, value); |
3371 | 73560bc8 | balrog | } |
3372 | 73560bc8 | balrog | |
3373 | a4ebbd18 | Avi Kivity | static void omap_mcbsp_write(void *opaque, target_phys_addr_t addr, |
3374 | a4ebbd18 | Avi Kivity | uint64_t value, unsigned size)
|
3375 | a4ebbd18 | Avi Kivity | { |
3376 | a4ebbd18 | Avi Kivity | switch (size) {
|
3377 | a4ebbd18 | Avi Kivity | case 2: return omap_mcbsp_writeh(opaque, addr, value); |
3378 | a4ebbd18 | Avi Kivity | case 4: return omap_mcbsp_writew(opaque, addr, value); |
3379 | a4ebbd18 | Avi Kivity | default: return omap_badwidth_write16(opaque, addr, value); |
3380 | a4ebbd18 | Avi Kivity | } |
3381 | a4ebbd18 | Avi Kivity | } |
3382 | d8f699cb | balrog | |
3383 | a4ebbd18 | Avi Kivity | static const MemoryRegionOps omap_mcbsp_ops = { |
3384 | a4ebbd18 | Avi Kivity | .read = omap_mcbsp_read, |
3385 | a4ebbd18 | Avi Kivity | .write = omap_mcbsp_write, |
3386 | a4ebbd18 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
3387 | d8f699cb | balrog | }; |
3388 | d8f699cb | balrog | |
3389 | d8f699cb | balrog | static void omap_mcbsp_reset(struct omap_mcbsp_s *s) |
3390 | d8f699cb | balrog | { |
3391 | d8f699cb | balrog | memset(&s->spcr, 0, sizeof(s->spcr)); |
3392 | d8f699cb | balrog | memset(&s->rcr, 0, sizeof(s->rcr)); |
3393 | d8f699cb | balrog | memset(&s->xcr, 0, sizeof(s->xcr)); |
3394 | d8f699cb | balrog | s->srgr[0] = 0x0001; |
3395 | d8f699cb | balrog | s->srgr[1] = 0x2000; |
3396 | d8f699cb | balrog | memset(&s->mcr, 0, sizeof(s->mcr)); |
3397 | d8f699cb | balrog | memset(&s->pcr, 0, sizeof(s->pcr)); |
3398 | d8f699cb | balrog | memset(&s->rcer, 0, sizeof(s->rcer)); |
3399 | d8f699cb | balrog | memset(&s->xcer, 0, sizeof(s->xcer)); |
3400 | d8f699cb | balrog | s->tx_req = 0;
|
3401 | 73560bc8 | balrog | s->rx_req = 0;
|
3402 | d8f699cb | balrog | s->tx_rate = 0;
|
3403 | d8f699cb | balrog | s->rx_rate = 0;
|
3404 | 73560bc8 | balrog | qemu_del_timer(s->source_timer); |
3405 | 73560bc8 | balrog | qemu_del_timer(s->sink_timer); |
3406 | d8f699cb | balrog | } |
3407 | d8f699cb | balrog | |
3408 | 0919ac78 | Peter Maydell | static struct omap_mcbsp_s *omap_mcbsp_init(MemoryRegion *system_memory, |
3409 | 0919ac78 | Peter Maydell | target_phys_addr_t base, |
3410 | 0919ac78 | Peter Maydell | qemu_irq txirq, qemu_irq rxirq, |
3411 | 0919ac78 | Peter Maydell | qemu_irq *dma, omap_clk clk) |
3412 | d8f699cb | balrog | { |
3413 | d8f699cb | balrog | struct omap_mcbsp_s *s = (struct omap_mcbsp_s *) |
3414 | 7267c094 | Anthony Liguori | g_malloc0(sizeof(struct omap_mcbsp_s)); |
3415 | d8f699cb | balrog | |
3416 | 0919ac78 | Peter Maydell | s->txirq = txirq; |
3417 | 0919ac78 | Peter Maydell | s->rxirq = rxirq; |
3418 | d8f699cb | balrog | s->txdrq = dma[0];
|
3419 | d8f699cb | balrog | s->rxdrq = dma[1];
|
3420 | 74475455 | Paolo Bonzini | s->sink_timer = qemu_new_timer_ns(vm_clock, omap_mcbsp_sink_tick, s); |
3421 | 74475455 | Paolo Bonzini | s->source_timer = qemu_new_timer_ns(vm_clock, omap_mcbsp_source_tick, s); |
3422 | d8f699cb | balrog | omap_mcbsp_reset(s); |
3423 | d8f699cb | balrog | |
3424 | a4ebbd18 | Avi Kivity | memory_region_init_io(&s->iomem, &omap_mcbsp_ops, s, "omap-mcbsp", 0x800); |
3425 | a4ebbd18 | Avi Kivity | memory_region_add_subregion(system_memory, base, &s->iomem); |
3426 | d8f699cb | balrog | |
3427 | d8f699cb | balrog | return s;
|
3428 | d8f699cb | balrog | } |
3429 | d8f699cb | balrog | |
3430 | 9596ebb7 | pbrook | static void omap_mcbsp_i2s_swallow(void *opaque, int line, int level) |
3431 | d8f699cb | balrog | { |
3432 | d8f699cb | balrog | struct omap_mcbsp_s *s = (struct omap_mcbsp_s *) opaque; |
3433 | d8f699cb | balrog | |
3434 | 73560bc8 | balrog | if (s->rx_rate) {
|
3435 | 73560bc8 | balrog | s->rx_req = s->codec->in.len; |
3436 | 73560bc8 | balrog | omap_mcbsp_rx_newdata(s); |
3437 | 73560bc8 | balrog | } |
3438 | d8f699cb | balrog | } |
3439 | d8f699cb | balrog | |
3440 | 9596ebb7 | pbrook | static void omap_mcbsp_i2s_start(void *opaque, int line, int level) |
3441 | d8f699cb | balrog | { |
3442 | d8f699cb | balrog | struct omap_mcbsp_s *s = (struct omap_mcbsp_s *) opaque; |
3443 | d8f699cb | balrog | |
3444 | 73560bc8 | balrog | if (s->tx_rate) {
|
3445 | 73560bc8 | balrog | s->tx_req = s->codec->out.size; |
3446 | 73560bc8 | balrog | omap_mcbsp_tx_newdata(s); |
3447 | 73560bc8 | balrog | } |
3448 | d8f699cb | balrog | } |
3449 | d8f699cb | balrog | |
3450 | bc24a225 | Paul Brook | void omap_mcbsp_i2s_attach(struct omap_mcbsp_s *s, I2SCodec *slave) |
3451 | d8f699cb | balrog | { |
3452 | d8f699cb | balrog | s->codec = slave; |
3453 | d8f699cb | balrog | slave->rx_swallow = qemu_allocate_irqs(omap_mcbsp_i2s_swallow, s, 1)[0]; |
3454 | d8f699cb | balrog | slave->tx_start = qemu_allocate_irqs(omap_mcbsp_i2s_start, s, 1)[0]; |
3455 | d8f699cb | balrog | } |
3456 | d8f699cb | balrog | |
3457 | f9d43072 | balrog | /* LED Pulse Generators */
|
3458 | f9d43072 | balrog | struct omap_lpg_s {
|
3459 | 60fe76e3 | Avi Kivity | MemoryRegion iomem; |
3460 | f9d43072 | balrog | QEMUTimer *tm; |
3461 | f9d43072 | balrog | |
3462 | f9d43072 | balrog | uint8_t control; |
3463 | f9d43072 | balrog | uint8_t power; |
3464 | f9d43072 | balrog | int64_t on; |
3465 | f9d43072 | balrog | int64_t period; |
3466 | f9d43072 | balrog | int clk;
|
3467 | f9d43072 | balrog | int cycle;
|
3468 | f9d43072 | balrog | }; |
3469 | f9d43072 | balrog | |
3470 | f9d43072 | balrog | static void omap_lpg_tick(void *opaque) |
3471 | f9d43072 | balrog | { |
3472 | f9d43072 | balrog | struct omap_lpg_s *s = opaque;
|
3473 | f9d43072 | balrog | |
3474 | f9d43072 | balrog | if (s->cycle)
|
3475 | 7bd427d8 | Paolo Bonzini | qemu_mod_timer(s->tm, qemu_get_clock_ms(rt_clock) + s->period - s->on); |
3476 | f9d43072 | balrog | else
|
3477 | 7bd427d8 | Paolo Bonzini | qemu_mod_timer(s->tm, qemu_get_clock_ms(rt_clock) + s->on); |
3478 | f9d43072 | balrog | |
3479 | f9d43072 | balrog | s->cycle = !s->cycle; |
3480 | f9d43072 | balrog | printf("%s: LED is %s\n", __FUNCTION__, s->cycle ? "on" : "off"); |
3481 | f9d43072 | balrog | } |
3482 | f9d43072 | balrog | |
3483 | f9d43072 | balrog | static void omap_lpg_update(struct omap_lpg_s *s) |
3484 | f9d43072 | balrog | { |
3485 | f9d43072 | balrog | int64_t on, period = 1, ticks = 1000; |
3486 | f9d43072 | balrog | static const int per[8] = { 1, 2, 4, 8, 12, 16, 20, 24 }; |
3487 | f9d43072 | balrog | |
3488 | f9d43072 | balrog | if (~s->control & (1 << 6)) /* LPGRES */ |
3489 | f9d43072 | balrog | on = 0;
|
3490 | f9d43072 | balrog | else if (s->control & (1 << 7)) /* PERM_ON */ |
3491 | f9d43072 | balrog | on = period; |
3492 | f9d43072 | balrog | else {
|
3493 | f9d43072 | balrog | period = muldiv64(ticks, per[s->control & 7], /* PERCTRL */ |
3494 | f9d43072 | balrog | 256 / 32); |
3495 | f9d43072 | balrog | on = (s->clk && s->power) ? muldiv64(ticks, |
3496 | f9d43072 | balrog | per[(s->control >> 3) & 7], 256) : 0; /* ONCTRL */ |
3497 | f9d43072 | balrog | } |
3498 | f9d43072 | balrog | |
3499 | f9d43072 | balrog | qemu_del_timer(s->tm); |
3500 | f9d43072 | balrog | if (on == period && s->on < s->period)
|
3501 | f9d43072 | balrog | printf("%s: LED is on\n", __FUNCTION__);
|
3502 | f9d43072 | balrog | else if (on == 0 && s->on) |
3503 | f9d43072 | balrog | printf("%s: LED is off\n", __FUNCTION__);
|
3504 | f9d43072 | balrog | else if (on && (on != s->on || period != s->period)) { |
3505 | f9d43072 | balrog | s->cycle = 0;
|
3506 | f9d43072 | balrog | s->on = on; |
3507 | f9d43072 | balrog | s->period = period; |
3508 | f9d43072 | balrog | omap_lpg_tick(s); |
3509 | f9d43072 | balrog | return;
|
3510 | f9d43072 | balrog | } |
3511 | f9d43072 | balrog | |
3512 | f9d43072 | balrog | s->on = on; |
3513 | f9d43072 | balrog | s->period = period; |
3514 | f9d43072 | balrog | } |
3515 | f9d43072 | balrog | |
3516 | f9d43072 | balrog | static void omap_lpg_reset(struct omap_lpg_s *s) |
3517 | f9d43072 | balrog | { |
3518 | f9d43072 | balrog | s->control = 0x00;
|
3519 | f9d43072 | balrog | s->power = 0x00;
|
3520 | f9d43072 | balrog | s->clk = 1;
|
3521 | f9d43072 | balrog | omap_lpg_update(s); |
3522 | f9d43072 | balrog | } |
3523 | f9d43072 | balrog | |
3524 | 60fe76e3 | Avi Kivity | static uint64_t omap_lpg_read(void *opaque, target_phys_addr_t addr, |
3525 | 60fe76e3 | Avi Kivity | unsigned size)
|
3526 | f9d43072 | balrog | { |
3527 | f9d43072 | balrog | struct omap_lpg_s *s = (struct omap_lpg_s *) opaque; |
3528 | f9d43072 | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
3529 | f9d43072 | balrog | |
3530 | 60fe76e3 | Avi Kivity | if (size != 1) { |
3531 | 60fe76e3 | Avi Kivity | return omap_badwidth_read8(opaque, addr);
|
3532 | 60fe76e3 | Avi Kivity | } |
3533 | 60fe76e3 | Avi Kivity | |
3534 | f9d43072 | balrog | switch (offset) {
|
3535 | f9d43072 | balrog | case 0x00: /* LCR */ |
3536 | f9d43072 | balrog | return s->control;
|
3537 | f9d43072 | balrog | |
3538 | f9d43072 | balrog | case 0x04: /* PMR */ |
3539 | f9d43072 | balrog | return s->power;
|
3540 | f9d43072 | balrog | } |
3541 | f9d43072 | balrog | |
3542 | f9d43072 | balrog | OMAP_BAD_REG(addr); |
3543 | f9d43072 | balrog | return 0; |
3544 | f9d43072 | balrog | } |
3545 | f9d43072 | balrog | |
3546 | c227f099 | Anthony Liguori | static void omap_lpg_write(void *opaque, target_phys_addr_t addr, |
3547 | 60fe76e3 | Avi Kivity | uint64_t value, unsigned size)
|
3548 | f9d43072 | balrog | { |
3549 | f9d43072 | balrog | struct omap_lpg_s *s = (struct omap_lpg_s *) opaque; |
3550 | f9d43072 | balrog | int offset = addr & OMAP_MPUI_REG_MASK;
|
3551 | f9d43072 | balrog | |
3552 | 60fe76e3 | Avi Kivity | if (size != 1) { |
3553 | 60fe76e3 | Avi Kivity | return omap_badwidth_write8(opaque, addr, value);
|
3554 | 60fe76e3 | Avi Kivity | } |
3555 | 60fe76e3 | Avi Kivity | |
3556 | f9d43072 | balrog | switch (offset) {
|
3557 | f9d43072 | balrog | case 0x00: /* LCR */ |
3558 | f9d43072 | balrog | if (~value & (1 << 6)) /* LPGRES */ |
3559 | f9d43072 | balrog | omap_lpg_reset(s); |
3560 | f9d43072 | balrog | s->control = value & 0xff;
|
3561 | f9d43072 | balrog | omap_lpg_update(s); |
3562 | f9d43072 | balrog | return;
|
3563 | f9d43072 | balrog | |
3564 | f9d43072 | balrog | case 0x04: /* PMR */ |
3565 | f9d43072 | balrog | s->power = value & 0x01;
|
3566 | f9d43072 | balrog | omap_lpg_update(s); |
3567 | f9d43072 | balrog | return;
|
3568 | f9d43072 | balrog | |
3569 | f9d43072 | balrog | default:
|
3570 | f9d43072 | balrog | OMAP_BAD_REG(addr); |
3571 | f9d43072 | balrog | return;
|
3572 | f9d43072 | balrog | } |
3573 | f9d43072 | balrog | } |
3574 | f9d43072 | balrog | |
3575 | 60fe76e3 | Avi Kivity | static const MemoryRegionOps omap_lpg_ops = { |
3576 | 60fe76e3 | Avi Kivity | .read = omap_lpg_read, |
3577 | 60fe76e3 | Avi Kivity | .write = omap_lpg_write, |
3578 | 60fe76e3 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
3579 | f9d43072 | balrog | }; |
3580 | f9d43072 | balrog | |
3581 | f9d43072 | balrog | static void omap_lpg_clk_update(void *opaque, int line, int on) |
3582 | f9d43072 | balrog | { |
3583 | f9d43072 | balrog | struct omap_lpg_s *s = (struct omap_lpg_s *) opaque; |
3584 | f9d43072 | balrog | |
3585 | f9d43072 | balrog | s->clk = on; |
3586 | f9d43072 | balrog | omap_lpg_update(s); |
3587 | f9d43072 | balrog | } |
3588 | f9d43072 | balrog | |
3589 | 60fe76e3 | Avi Kivity | static struct omap_lpg_s *omap_lpg_init(MemoryRegion *system_memory, |
3590 | 60fe76e3 | Avi Kivity | target_phys_addr_t base, omap_clk clk) |
3591 | f9d43072 | balrog | { |
3592 | f9d43072 | balrog | struct omap_lpg_s *s = (struct omap_lpg_s *) |
3593 | 7267c094 | Anthony Liguori | g_malloc0(sizeof(struct omap_lpg_s)); |
3594 | f9d43072 | balrog | |
3595 | 7bd427d8 | Paolo Bonzini | s->tm = qemu_new_timer_ms(rt_clock, omap_lpg_tick, s); |
3596 | f9d43072 | balrog | |
3597 | f9d43072 | balrog | omap_lpg_reset(s); |
3598 | f9d43072 | balrog | |
3599 | 60fe76e3 | Avi Kivity | memory_region_init_io(&s->iomem, &omap_lpg_ops, s, "omap-lpg", 0x800); |
3600 | 60fe76e3 | Avi Kivity | memory_region_add_subregion(system_memory, base, &s->iomem); |
3601 | f9d43072 | balrog | |
3602 | f9d43072 | balrog | omap_clk_adduser(clk, qemu_allocate_irqs(omap_lpg_clk_update, s, 1)[0]); |
3603 | f9d43072 | balrog | |
3604 | f9d43072 | balrog | return s;
|
3605 | f9d43072 | balrog | } |
3606 | f9d43072 | balrog | |
3607 | f9d43072 | balrog | /* MPUI Peripheral Bridge configuration */
|
3608 | 60fe76e3 | Avi Kivity | static uint64_t omap_mpui_io_read(void *opaque, target_phys_addr_t addr, |
3609 | 60fe76e3 | Avi Kivity | unsigned size)
|
3610 | f9d43072 | balrog | { |
3611 | 60fe76e3 | Avi Kivity | if (size != 2) { |
3612 | 60fe76e3 | Avi Kivity | return omap_badwidth_read16(opaque, addr);
|
3613 | 60fe76e3 | Avi Kivity | } |
3614 | 60fe76e3 | Avi Kivity | |
3615 | f9d43072 | balrog | if (addr == OMAP_MPUI_BASE) /* CMR */ |
3616 | f9d43072 | balrog | return 0xfe4d; |
3617 | f9d43072 | balrog | |
3618 | f9d43072 | balrog | OMAP_BAD_REG(addr); |
3619 | f9d43072 | balrog | return 0; |
3620 | f9d43072 | balrog | } |
3621 | f9d43072 | balrog | |
3622 | 60fe76e3 | Avi Kivity | static void omap_mpui_io_write(void *opaque, target_phys_addr_t addr, |
3623 | 60fe76e3 | Avi Kivity | uint64_t value, unsigned size)
|
3624 | 60fe76e3 | Avi Kivity | { |
3625 | 60fe76e3 | Avi Kivity | /* FIXME: infinite loop */
|
3626 | 60fe76e3 | Avi Kivity | omap_badwidth_write16(opaque, addr, value); |
3627 | 60fe76e3 | Avi Kivity | } |
3628 | f9d43072 | balrog | |
3629 | 60fe76e3 | Avi Kivity | static const MemoryRegionOps omap_mpui_io_ops = { |
3630 | 60fe76e3 | Avi Kivity | .read = omap_mpui_io_read, |
3631 | 60fe76e3 | Avi Kivity | .write = omap_mpui_io_write, |
3632 | 60fe76e3 | Avi Kivity | .endianness = DEVICE_NATIVE_ENDIAN, |
3633 | f9d43072 | balrog | }; |
3634 | f9d43072 | balrog | |
3635 | 60fe76e3 | Avi Kivity | static void omap_setup_mpui_io(MemoryRegion *system_memory, |
3636 | 60fe76e3 | Avi Kivity | struct omap_mpu_state_s *mpu)
|
3637 | f9d43072 | balrog | { |
3638 | 60fe76e3 | Avi Kivity | memory_region_init_io(&mpu->mpui_io_iomem, &omap_mpui_io_ops, mpu, |
3639 | 60fe76e3 | Avi Kivity | "omap-mpui-io", 0x7fff); |
3640 | 60fe76e3 | Avi Kivity | memory_region_add_subregion(system_memory, OMAP_MPUI_BASE, |
3641 | 60fe76e3 | Avi Kivity | &mpu->mpui_io_iomem); |
3642 | f9d43072 | balrog | } |
3643 | f9d43072 | balrog | |
3644 | c3d2689d | balrog | /* General chip reset */
|
3645 | 827df9f3 | balrog | static void omap1_mpu_reset(void *opaque) |
3646 | c3d2689d | balrog | { |
3647 | c3d2689d | balrog | struct omap_mpu_state_s *mpu = (struct omap_mpu_state_s *) opaque; |
3648 | c3d2689d | balrog | |
3649 | c3d2689d | balrog | omap_dma_reset(mpu->dma); |
3650 | c3d2689d | balrog | omap_mpu_timer_reset(mpu->timer[0]);
|
3651 | c3d2689d | balrog | omap_mpu_timer_reset(mpu->timer[1]);
|
3652 | c3d2689d | balrog | omap_mpu_timer_reset(mpu->timer[2]);
|
3653 | c3d2689d | balrog | omap_wd_timer_reset(mpu->wdt); |
3654 | c3d2689d | balrog | omap_os_timer_reset(mpu->os_timer); |
3655 | c3d2689d | balrog | omap_lcdc_reset(mpu->lcd); |
3656 | c3d2689d | balrog | omap_ulpd_pm_reset(mpu); |
3657 | c3d2689d | balrog | omap_pin_cfg_reset(mpu); |
3658 | c3d2689d | balrog | omap_mpui_reset(mpu); |
3659 | c3d2689d | balrog | omap_tipb_bridge_reset(mpu->private_tipb); |
3660 | c3d2689d | balrog | omap_tipb_bridge_reset(mpu->public_tipb); |
3661 | c3d2689d | balrog | omap_dpll_reset(&mpu->dpll[0]);
|
3662 | c3d2689d | balrog | omap_dpll_reset(&mpu->dpll[1]);
|
3663 | c3d2689d | balrog | omap_dpll_reset(&mpu->dpll[2]);
|
3664 | d951f6ff | balrog | omap_uart_reset(mpu->uart[0]);
|
3665 | d951f6ff | balrog | omap_uart_reset(mpu->uart[1]);
|
3666 | d951f6ff | balrog | omap_uart_reset(mpu->uart[2]);
|
3667 | b30bb3a2 | balrog | omap_mmc_reset(mpu->mmc); |
3668 | fe71e81a | balrog | omap_mpuio_reset(mpu->mpuio); |
3669 | d951f6ff | balrog | omap_uwire_reset(mpu->microwire); |
3670 | 66450b15 | balrog | omap_pwl_reset(mpu); |
3671 | 4a2c8ac2 | balrog | omap_pwt_reset(mpu); |
3672 | 827df9f3 | balrog | omap_i2c_reset(mpu->i2c[0]);
|
3673 | 5c1c390f | balrog | omap_rtc_reset(mpu->rtc); |
3674 | d8f699cb | balrog | omap_mcbsp_reset(mpu->mcbsp1); |
3675 | d8f699cb | balrog | omap_mcbsp_reset(mpu->mcbsp2); |
3676 | d8f699cb | balrog | omap_mcbsp_reset(mpu->mcbsp3); |
3677 | f9d43072 | balrog | omap_lpg_reset(mpu->led[0]);
|
3678 | f9d43072 | balrog | omap_lpg_reset(mpu->led[1]);
|
3679 | 8ef6367e | balrog | omap_clkm_reset(mpu); |
3680 | c3d2689d | balrog | cpu_reset(mpu->env); |
3681 | c3d2689d | balrog | } |
3682 | c3d2689d | balrog | |
3683 | cf965d24 | balrog | static const struct omap_map_s { |
3684 | c227f099 | Anthony Liguori | target_phys_addr_t phys_dsp; |
3685 | c227f099 | Anthony Liguori | target_phys_addr_t phys_mpu; |
3686 | cf965d24 | balrog | uint32_t size; |
3687 | cf965d24 | balrog | const char *name; |
3688 | cf965d24 | balrog | } omap15xx_dsp_mm[] = { |
3689 | cf965d24 | balrog | /* Strobe 0 */
|
3690 | cf965d24 | balrog | { 0xe1010000, 0xfffb0000, 0x800, "UART1 BT" }, /* CS0 */ |
3691 | cf965d24 | balrog | { 0xe1010800, 0xfffb0800, 0x800, "UART2 COM" }, /* CS1 */ |
3692 | cf965d24 | balrog | { 0xe1011800, 0xfffb1800, 0x800, "McBSP1 audio" }, /* CS3 */ |
3693 | cf965d24 | balrog | { 0xe1012000, 0xfffb2000, 0x800, "MCSI2 communication" }, /* CS4 */ |
3694 | cf965d24 | balrog | { 0xe1012800, 0xfffb2800, 0x800, "MCSI1 BT u-Law" }, /* CS5 */ |
3695 | cf965d24 | balrog | { 0xe1013000, 0xfffb3000, 0x800, "uWire" }, /* CS6 */ |
3696 | cf965d24 | balrog | { 0xe1013800, 0xfffb3800, 0x800, "I^2C" }, /* CS7 */ |
3697 | cf965d24 | balrog | { 0xe1014000, 0xfffb4000, 0x800, "USB W2FC" }, /* CS8 */ |
3698 | cf965d24 | balrog | { 0xe1014800, 0xfffb4800, 0x800, "RTC" }, /* CS9 */ |
3699 | cf965d24 | balrog | { 0xe1015000, 0xfffb5000, 0x800, "MPUIO" }, /* CS10 */ |
3700 | cf965d24 | balrog | { 0xe1015800, 0xfffb5800, 0x800, "PWL" }, /* CS11 */ |
3701 | cf965d24 | balrog | { 0xe1016000, 0xfffb6000, 0x800, "PWT" }, /* CS12 */ |
3702 | cf965d24 | balrog | { 0xe1017000, 0xfffb7000, 0x800, "McBSP3" }, /* CS14 */ |
3703 | cf965d24 | balrog | { 0xe1017800, 0xfffb7800, 0x800, "MMC" }, /* CS15 */ |
3704 | cf965d24 | balrog | { 0xe1019000, 0xfffb9000, 0x800, "32-kHz timer" }, /* CS18 */ |
3705 | cf965d24 | balrog | { 0xe1019800, 0xfffb9800, 0x800, "UART3" }, /* CS19 */ |
3706 | cf965d24 | balrog | { 0xe101c800, 0xfffbc800, 0x800, "TIPB switches" }, /* CS25 */ |
3707 | cf965d24 | balrog | /* Strobe 1 */
|
3708 | cf965d24 | balrog | { 0xe101e000, 0xfffce000, 0x800, "GPIOs" }, /* CS28 */ |
3709 | cf965d24 | balrog | |
3710 | cf965d24 | balrog | { 0 }
|
3711 | cf965d24 | balrog | }; |
3712 | cf965d24 | balrog | |
3713 | 763b946c | Avi Kivity | static void omap_setup_dsp_mapping(MemoryRegion *system_memory, |
3714 | 763b946c | Avi Kivity | const struct omap_map_s *map) |
3715 | cf965d24 | balrog | { |
3716 | 763b946c | Avi Kivity | MemoryRegion *io; |
3717 | cf965d24 | balrog | |
3718 | cf965d24 | balrog | for (; map->phys_dsp; map ++) {
|
3719 | 763b946c | Avi Kivity | io = g_new(MemoryRegion, 1);
|
3720 | 763b946c | Avi Kivity | memory_region_init_alias(io, map->name, |
3721 | 763b946c | Avi Kivity | system_memory, map->phys_mpu, map->size); |
3722 | 763b946c | Avi Kivity | memory_region_add_subregion(system_memory, map->phys_dsp, io); |
3723 | cf965d24 | balrog | } |
3724 | cf965d24 | balrog | } |
3725 | cf965d24 | balrog | |
3726 | 827df9f3 | balrog | void omap_mpu_wakeup(void *opaque, int irq, int req) |
3727 | c3d2689d | balrog | { |
3728 | c3d2689d | balrog | struct omap_mpu_state_s *mpu = (struct omap_mpu_state_s *) opaque; |
3729 | c3d2689d | balrog | |
3730 | fe71e81a | balrog | if (mpu->env->halted)
|
3731 | fe71e81a | balrog | cpu_interrupt(mpu->env, CPU_INTERRUPT_EXITTB); |
3732 | c3d2689d | balrog | } |
3733 | c3d2689d | balrog | |
3734 | 827df9f3 | balrog | static const struct dma_irq_map omap1_dma_irq_map[] = { |
3735 | 089b7c0a | balrog | { 0, OMAP_INT_DMA_CH0_6 },
|
3736 | 089b7c0a | balrog | { 0, OMAP_INT_DMA_CH1_7 },
|
3737 | 089b7c0a | balrog | { 0, OMAP_INT_DMA_CH2_8 },
|
3738 | 089b7c0a | balrog | { 0, OMAP_INT_DMA_CH3 },
|
3739 | 089b7c0a | balrog | { 0, OMAP_INT_DMA_CH4 },
|
3740 | 089b7c0a | balrog | { 0, OMAP_INT_DMA_CH5 },
|
3741 | 089b7c0a | balrog | { 1, OMAP_INT_1610_DMA_CH6 },
|
3742 | 089b7c0a | balrog | { 1, OMAP_INT_1610_DMA_CH7 },
|
3743 | 089b7c0a | balrog | { 1, OMAP_INT_1610_DMA_CH8 },
|
3744 | 089b7c0a | balrog | { 1, OMAP_INT_1610_DMA_CH9 },
|
3745 | 089b7c0a | balrog | { 1, OMAP_INT_1610_DMA_CH10 },
|
3746 | 089b7c0a | balrog | { 1, OMAP_INT_1610_DMA_CH11 },
|
3747 | 089b7c0a | balrog | { 1, OMAP_INT_1610_DMA_CH12 },
|
3748 | 089b7c0a | balrog | { 1, OMAP_INT_1610_DMA_CH13 },
|
3749 | 089b7c0a | balrog | { 1, OMAP_INT_1610_DMA_CH14 },
|
3750 | 089b7c0a | balrog | { 1, OMAP_INT_1610_DMA_CH15 }
|
3751 | 089b7c0a | balrog | }; |
3752 | 089b7c0a | balrog | |
3753 | b4e3104b | balrog | /* DMA ports for OMAP1 */
|
3754 | b4e3104b | balrog | static int omap_validate_emiff_addr(struct omap_mpu_state_s *s, |
3755 | c227f099 | Anthony Liguori | target_phys_addr_t addr) |
3756 | b4e3104b | balrog | { |
3757 | 45416789 | Blue Swirl | return range_covers_byte(OMAP_EMIFF_BASE, s->sdram_size, addr);
|
3758 | b4e3104b | balrog | } |
3759 | b4e3104b | balrog | |
3760 | b4e3104b | balrog | static int omap_validate_emifs_addr(struct omap_mpu_state_s *s, |
3761 | c227f099 | Anthony Liguori | target_phys_addr_t addr) |
3762 | b4e3104b | balrog | { |
3763 | 45416789 | Blue Swirl | return range_covers_byte(OMAP_EMIFS_BASE, OMAP_EMIFF_BASE - OMAP_EMIFS_BASE,
|
3764 | 45416789 | Blue Swirl | addr); |
3765 | b4e3104b | balrog | } |
3766 | b4e3104b | balrog | |
3767 | b4e3104b | balrog | static int omap_validate_imif_addr(struct omap_mpu_state_s *s, |
3768 | c227f099 | Anthony Liguori | target_phys_addr_t addr) |
3769 | b4e3104b | balrog | { |
3770 | 45416789 | Blue Swirl | return range_covers_byte(OMAP_IMIF_BASE, s->sram_size, addr);
|
3771 | b4e3104b | balrog | } |
3772 | b4e3104b | balrog | |
3773 | b4e3104b | balrog | static int omap_validate_tipb_addr(struct omap_mpu_state_s *s, |
3774 | c227f099 | Anthony Liguori | target_phys_addr_t addr) |
3775 | b4e3104b | balrog | { |
3776 | 45416789 | Blue Swirl | return range_covers_byte(0xfffb0000, 0xffff0000 - 0xfffb0000, addr); |
3777 | b4e3104b | balrog | } |
3778 | b4e3104b | balrog | |
3779 | b4e3104b | balrog | static int omap_validate_local_addr(struct omap_mpu_state_s *s, |
3780 | c227f099 | Anthony Liguori | target_phys_addr_t addr) |
3781 | b4e3104b | balrog | { |
3782 | 45416789 | Blue Swirl | return range_covers_byte(OMAP_LOCALBUS_BASE, 0x1000000, addr); |
3783 | b4e3104b | balrog | } |
3784 | b4e3104b | balrog | |
3785 | b4e3104b | balrog | static int omap_validate_tipb_mpui_addr(struct omap_mpu_state_s *s, |
3786 | c227f099 | Anthony Liguori | target_phys_addr_t addr) |
3787 | b4e3104b | balrog | { |
3788 | 45416789 | Blue Swirl | return range_covers_byte(0xe1010000, 0xe1020004 - 0xe1010000, addr); |
3789 | b4e3104b | balrog | } |
3790 | b4e3104b | balrog | |
3791 | 4b3fedf3 | Avi Kivity | struct omap_mpu_state_s *omap310_mpu_init(MemoryRegion *system_memory,
|
3792 | 4b3fedf3 | Avi Kivity | unsigned long sdram_size, |
3793 | 3023f332 | aliguori | const char *core) |
3794 | c3d2689d | balrog | { |
3795 | 089b7c0a | balrog | int i;
|
3796 | c3d2689d | balrog | struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) |
3797 | 7267c094 | Anthony Liguori | g_malloc0(sizeof(struct omap_mpu_state_s)); |
3798 | 106627d0 | balrog | qemu_irq *cpu_irq; |
3799 | 089b7c0a | balrog | qemu_irq dma_irqs[6];
|
3800 | 751c6a17 | Gerd Hoffmann | DriveInfo *dinfo; |
3801 | 0919ac78 | Peter Maydell | SysBusDevice *busdev; |
3802 | 106627d0 | balrog | |
3803 | aaed909a | bellard | if (!core)
|
3804 | aaed909a | bellard | core = "ti925t";
|
3805 | c3d2689d | balrog | |
3806 | c3d2689d | balrog | /* Core */
|
3807 | c3d2689d | balrog | s->mpu_model = omap310; |
3808 | aaed909a | bellard | s->env = cpu_init(core); |
3809 | aaed909a | bellard | if (!s->env) {
|
3810 | aaed909a | bellard | fprintf(stderr, "Unable to find CPU definition\n");
|
3811 | aaed909a | bellard | exit(1);
|
3812 | aaed909a | bellard | } |
3813 | c3d2689d | balrog | s->sdram_size = sdram_size; |
3814 | c3d2689d | balrog | s->sram_size = OMAP15XX_SRAM_SIZE; |
3815 | c3d2689d | balrog | |
3816 | fe71e81a | balrog | s->wakeup = qemu_allocate_irqs(omap_mpu_wakeup, s, 1)[0]; |
3817 | fe71e81a | balrog | |
3818 | c3d2689d | balrog | /* Clocks */
|
3819 | c3d2689d | balrog | omap_clk_init(s); |
3820 | c3d2689d | balrog | |
3821 | c3d2689d | balrog | /* Memory-mapped stuff */
|
3822 | 2654c962 | Avi Kivity | memory_region_init_ram(&s->emiff_ram, NULL, "omap1.dram", s->sdram_size); |
3823 | 2654c962 | Avi Kivity | memory_region_add_subregion(system_memory, OMAP_EMIFF_BASE, &s->emiff_ram); |
3824 | 2654c962 | Avi Kivity | memory_region_init_ram(&s->imif_ram, NULL, "omap1.sram", s->sram_size); |
3825 | 2654c962 | Avi Kivity | memory_region_add_subregion(system_memory, OMAP_IMIF_BASE, &s->imif_ram); |
3826 | c3d2689d | balrog | |
3827 | e7aa0ae0 | Avi Kivity | omap_clkm_init(system_memory, 0xfffece00, 0xe1008000, s); |
3828 | c3d2689d | balrog | |
3829 | 106627d0 | balrog | cpu_irq = arm_pic_init_cpu(s->env); |
3830 | 0919ac78 | Peter Maydell | s->ih[0] = qdev_create(NULL, "omap-intc"); |
3831 | 0919ac78 | Peter Maydell | qdev_prop_set_uint32(s->ih[0], "size", 0x100); |
3832 | 0919ac78 | Peter Maydell | qdev_prop_set_ptr(s->ih[0], "clk", omap_findclk(s, "arminth_ck")); |
3833 | 0919ac78 | Peter Maydell | qdev_init_nofail(s->ih[0]);
|
3834 | 0919ac78 | Peter Maydell | busdev = sysbus_from_qdev(s->ih[0]);
|
3835 | 0919ac78 | Peter Maydell | sysbus_connect_irq(busdev, 0, cpu_irq[ARM_PIC_CPU_IRQ]);
|
3836 | 0919ac78 | Peter Maydell | sysbus_connect_irq(busdev, 1, cpu_irq[ARM_PIC_CPU_FIQ]);
|
3837 | 0919ac78 | Peter Maydell | sysbus_mmio_map(busdev, 0, 0xfffecb00); |
3838 | 0919ac78 | Peter Maydell | s->ih[1] = qdev_create(NULL, "omap-intc"); |
3839 | 0919ac78 | Peter Maydell | qdev_prop_set_uint32(s->ih[1], "size", 0x800); |
3840 | 0919ac78 | Peter Maydell | qdev_prop_set_ptr(s->ih[1], "clk", omap_findclk(s, "arminth_ck")); |
3841 | 0919ac78 | Peter Maydell | qdev_init_nofail(s->ih[1]);
|
3842 | 0919ac78 | Peter Maydell | busdev = sysbus_from_qdev(s->ih[1]);
|
3843 | 0919ac78 | Peter Maydell | sysbus_connect_irq(busdev, 0,
|
3844 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[0], OMAP_INT_15XX_IH2_IRQ));
|
3845 | 0919ac78 | Peter Maydell | /* The second interrupt controller's FIQ output is not wired up */
|
3846 | 0919ac78 | Peter Maydell | sysbus_mmio_map(busdev, 0, 0xfffe0000); |
3847 | 0919ac78 | Peter Maydell | |
3848 | 0919ac78 | Peter Maydell | for (i = 0; i < 6; i++) { |
3849 | 0919ac78 | Peter Maydell | dma_irqs[i] = qdev_get_gpio_in(s->ih[omap1_dma_irq_map[i].ih], |
3850 | 0919ac78 | Peter Maydell | omap1_dma_irq_map[i].intr); |
3851 | 0919ac78 | Peter Maydell | } |
3852 | 0919ac78 | Peter Maydell | s->dma = omap_dma_init(0xfffed800, dma_irqs,
|
3853 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[0], OMAP_INT_DMA_LCD),
|
3854 | 089b7c0a | balrog | s, omap_findclk(s, "dma_ck"), omap_dma_3_1);
|
3855 | 089b7c0a | balrog | |
3856 | c3d2689d | balrog | s->port[emiff ].addr_valid = omap_validate_emiff_addr; |
3857 | c3d2689d | balrog | s->port[emifs ].addr_valid = omap_validate_emifs_addr; |
3858 | c3d2689d | balrog | s->port[imif ].addr_valid = omap_validate_imif_addr; |
3859 | c3d2689d | balrog | s->port[tipb ].addr_valid = omap_validate_tipb_addr; |
3860 | c3d2689d | balrog | s->port[local ].addr_valid = omap_validate_local_addr; |
3861 | c3d2689d | balrog | s->port[tipb_mpui].addr_valid = omap_validate_tipb_mpui_addr; |
3862 | c3d2689d | balrog | |
3863 | afbb5194 | balrog | /* Register SDRAM and SRAM DMA ports for fast transfers. */
|
3864 | 2654c962 | Avi Kivity | soc_dma_port_add_mem(s->dma, memory_region_get_ram_ptr(&s->emiff_ram), |
3865 | 2654c962 | Avi Kivity | OMAP_EMIFF_BASE, s->sdram_size); |
3866 | 2654c962 | Avi Kivity | soc_dma_port_add_mem(s->dma, memory_region_get_ram_ptr(&s->imif_ram), |
3867 | 90aeba9d | Avi Kivity | OMAP_IMIF_BASE, s->sram_size); |
3868 | afbb5194 | balrog | |
3869 | 4b3fedf3 | Avi Kivity | s->timer[0] = omap_mpu_timer_init(system_memory, 0xfffec500, |
3870 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[0], OMAP_INT_TIMER1),
|
3871 | c3d2689d | balrog | omap_findclk(s, "mputim_ck"));
|
3872 | 4b3fedf3 | Avi Kivity | s->timer[1] = omap_mpu_timer_init(system_memory, 0xfffec600, |
3873 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[0], OMAP_INT_TIMER2),
|
3874 | c3d2689d | balrog | omap_findclk(s, "mputim_ck"));
|
3875 | 4b3fedf3 | Avi Kivity | s->timer[2] = omap_mpu_timer_init(system_memory, 0xfffec700, |
3876 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[0], OMAP_INT_TIMER3),
|
3877 | c3d2689d | balrog | omap_findclk(s, "mputim_ck"));
|
3878 | c3d2689d | balrog | |
3879 | 4b3fedf3 | Avi Kivity | s->wdt = omap_wd_timer_init(system_memory, 0xfffec800,
|
3880 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[0], OMAP_INT_WD_TIMER),
|
3881 | c3d2689d | balrog | omap_findclk(s, "armwdt_ck"));
|
3882 | c3d2689d | balrog | |
3883 | 4b3fedf3 | Avi Kivity | s->os_timer = omap_os_timer_init(system_memory, 0xfffb9000,
|
3884 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[1], OMAP_INT_OS_TIMER),
|
3885 | c3d2689d | balrog | omap_findclk(s, "clk32-kHz"));
|
3886 | c3d2689d | balrog | |
3887 | 0919ac78 | Peter Maydell | s->lcd = omap_lcdc_init(0xfffec000,
|
3888 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[0], OMAP_INT_LCD_CTRL),
|
3889 | 0919ac78 | Peter Maydell | omap_dma_get_lcdch(s->dma), |
3890 | 0919ac78 | Peter Maydell | omap_findclk(s, "lcd_ck"));
|
3891 | c3d2689d | balrog | |
3892 | 4b3fedf3 | Avi Kivity | omap_ulpd_pm_init(system_memory, 0xfffe0800, s);
|
3893 | 4b3fedf3 | Avi Kivity | omap_pin_cfg_init(system_memory, 0xfffe1000, s);
|
3894 | 4b3fedf3 | Avi Kivity | omap_id_init(system_memory, s); |
3895 | c3d2689d | balrog | |
3896 | 4b3fedf3 | Avi Kivity | omap_mpui_init(system_memory, 0xfffec900, s);
|
3897 | c3d2689d | balrog | |
3898 | 4b3fedf3 | Avi Kivity | s->private_tipb = omap_tipb_bridge_init(system_memory, 0xfffeca00,
|
3899 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[0], OMAP_INT_BRIDGE_PRIV),
|
3900 | c3d2689d | balrog | omap_findclk(s, "tipb_ck"));
|
3901 | 4b3fedf3 | Avi Kivity | s->public_tipb = omap_tipb_bridge_init(system_memory, 0xfffed300,
|
3902 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[0], OMAP_INT_BRIDGE_PUB),
|
3903 | c3d2689d | balrog | omap_findclk(s, "tipb_ck"));
|
3904 | c3d2689d | balrog | |
3905 | e7aa0ae0 | Avi Kivity | omap_tcmi_init(system_memory, 0xfffecc00, s);
|
3906 | c3d2689d | balrog | |
3907 | 0919ac78 | Peter Maydell | s->uart[0] = omap_uart_init(0xfffb0000, |
3908 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[1], OMAP_INT_UART1),
|
3909 | c3d2689d | balrog | omap_findclk(s, "uart1_ck"),
|
3910 | 827df9f3 | balrog | omap_findclk(s, "uart1_ck"),
|
3911 | 827df9f3 | balrog | s->drq[OMAP_DMA_UART1_TX], s->drq[OMAP_DMA_UART1_RX], |
3912 | 6a8aabd3 | Stefan Weil | "uart1",
|
3913 | c3d2689d | balrog | serial_hds[0]);
|
3914 | 0919ac78 | Peter Maydell | s->uart[1] = omap_uart_init(0xfffb0800, |
3915 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[1], OMAP_INT_UART2),
|
3916 | c3d2689d | balrog | omap_findclk(s, "uart2_ck"),
|
3917 | 827df9f3 | balrog | omap_findclk(s, "uart2_ck"),
|
3918 | 827df9f3 | balrog | s->drq[OMAP_DMA_UART2_TX], s->drq[OMAP_DMA_UART2_RX], |
3919 | 6a8aabd3 | Stefan Weil | "uart2",
|
3920 | b9d38e95 | Blue Swirl | serial_hds[0] ? serial_hds[1] : NULL); |
3921 | 0919ac78 | Peter Maydell | s->uart[2] = omap_uart_init(0xfffb9800, |
3922 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[0], OMAP_INT_UART3),
|
3923 | c3d2689d | balrog | omap_findclk(s, "uart3_ck"),
|
3924 | 827df9f3 | balrog | omap_findclk(s, "uart3_ck"),
|
3925 | 827df9f3 | balrog | s->drq[OMAP_DMA_UART3_TX], s->drq[OMAP_DMA_UART3_RX], |
3926 | 6a8aabd3 | Stefan Weil | "uart3",
|
3927 | b9d38e95 | Blue Swirl | serial_hds[0] && serial_hds[1] ? serial_hds[2] : NULL); |
3928 | c3d2689d | balrog | |
3929 | e7aa0ae0 | Avi Kivity | omap_dpll_init(system_memory, |
3930 | e7aa0ae0 | Avi Kivity | &s->dpll[0], 0xfffecf00, omap_findclk(s, "dpll1")); |
3931 | e7aa0ae0 | Avi Kivity | omap_dpll_init(system_memory, |
3932 | e7aa0ae0 | Avi Kivity | &s->dpll[1], 0xfffed000, omap_findclk(s, "dpll2")); |
3933 | e7aa0ae0 | Avi Kivity | omap_dpll_init(system_memory, |
3934 | e7aa0ae0 | Avi Kivity | &s->dpll[2], 0xfffed100, omap_findclk(s, "dpll3")); |
3935 | c3d2689d | balrog | |
3936 | 751c6a17 | Gerd Hoffmann | dinfo = drive_get(IF_SD, 0, 0); |
3937 | 751c6a17 | Gerd Hoffmann | if (!dinfo) {
|
3938 | e4bcb14c | ths | fprintf(stderr, "qemu: missing SecureDigital device\n");
|
3939 | e4bcb14c | ths | exit(1);
|
3940 | e4bcb14c | ths | } |
3941 | 751c6a17 | Gerd Hoffmann | s->mmc = omap_mmc_init(0xfffb7800, dinfo->bdrv,
|
3942 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[1], OMAP_INT_OQN),
|
3943 | 0919ac78 | Peter Maydell | &s->drq[OMAP_DMA_MMC_TX], |
3944 | 9d413d1d | balrog | omap_findclk(s, "mmc_ck"));
|
3945 | b30bb3a2 | balrog | |
3946 | e7aa0ae0 | Avi Kivity | s->mpuio = omap_mpuio_init(system_memory, 0xfffb5000,
|
3947 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[1], OMAP_INT_KEYBOARD),
|
3948 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[1], OMAP_INT_MPUIO),
|
3949 | 0919ac78 | Peter Maydell | s->wakeup, omap_findclk(s, "clk32-kHz"));
|
3950 | fe71e81a | balrog | |
3951 | 77831c20 | Juha Riihimäki | s->gpio = qdev_create(NULL, "omap-gpio"); |
3952 | 77831c20 | Juha Riihimäki | qdev_prop_set_int32(s->gpio, "mpu_model", s->mpu_model);
|
3953 | bdbc1b3c | Peter Maydell | qdev_prop_set_ptr(s->gpio, "clk", omap_findclk(s, "arm_gpio_ck")); |
3954 | 77831c20 | Juha Riihimäki | qdev_init_nofail(s->gpio); |
3955 | 77831c20 | Juha Riihimäki | sysbus_connect_irq(sysbus_from_qdev(s->gpio), 0,
|
3956 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[0], OMAP_INT_GPIO_BANK1));
|
3957 | 77831c20 | Juha Riihimäki | sysbus_mmio_map(sysbus_from_qdev(s->gpio), 0, 0xfffce000); |
3958 | 64330148 | balrog | |
3959 | 0919ac78 | Peter Maydell | s->microwire = omap_uwire_init(system_memory, 0xfffb3000,
|
3960 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[1], OMAP_INT_uWireTX),
|
3961 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[1], OMAP_INT_uWireRX),
|
3962 | d951f6ff | balrog | s->drq[OMAP_DMA_UWIRE_TX], omap_findclk(s, "mpuper_ck"));
|
3963 | d951f6ff | balrog | |
3964 | a4ebbd18 | Avi Kivity | omap_pwl_init(system_memory, 0xfffb5800, s, omap_findclk(s, "armxor_ck")); |
3965 | a4ebbd18 | Avi Kivity | omap_pwt_init(system_memory, 0xfffb6000, s, omap_findclk(s, "armxor_ck")); |
3966 | 66450b15 | balrog | |
3967 | 0919ac78 | Peter Maydell | s->i2c[0] = omap_i2c_init(0xfffb3800, |
3968 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[1], OMAP_INT_I2C),
|
3969 | 4a2c8ac2 | balrog | &s->drq[OMAP_DMA_I2C_RX], omap_findclk(s, "mpuper_ck"));
|
3970 | 4a2c8ac2 | balrog | |
3971 | a4ebbd18 | Avi Kivity | s->rtc = omap_rtc_init(system_memory, 0xfffb4800,
|
3972 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[1], OMAP_INT_RTC_TIMER),
|
3973 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[1], OMAP_INT_RTC_ALARM),
|
3974 | 5c1c390f | balrog | omap_findclk(s, "clk32-kHz"));
|
3975 | 02645926 | balrog | |
3976 | 0919ac78 | Peter Maydell | s->mcbsp1 = omap_mcbsp_init(system_memory, 0xfffb1800,
|
3977 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[1], OMAP_INT_McBSP1TX),
|
3978 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[1], OMAP_INT_McBSP1RX),
|
3979 | d8f699cb | balrog | &s->drq[OMAP_DMA_MCBSP1_TX], omap_findclk(s, "dspxor_ck"));
|
3980 | 0919ac78 | Peter Maydell | s->mcbsp2 = omap_mcbsp_init(system_memory, 0xfffb1000,
|
3981 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[0],
|
3982 | 0919ac78 | Peter Maydell | OMAP_INT_310_McBSP2_TX), |
3983 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[0],
|
3984 | 0919ac78 | Peter Maydell | OMAP_INT_310_McBSP2_RX), |
3985 | d8f699cb | balrog | &s->drq[OMAP_DMA_MCBSP2_TX], omap_findclk(s, "mpuper_ck"));
|
3986 | 0919ac78 | Peter Maydell | s->mcbsp3 = omap_mcbsp_init(system_memory, 0xfffb7000,
|
3987 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[1], OMAP_INT_McBSP3TX),
|
3988 | 0919ac78 | Peter Maydell | qdev_get_gpio_in(s->ih[1], OMAP_INT_McBSP3RX),
|
3989 | d8f699cb | balrog | &s->drq[OMAP_DMA_MCBSP3_TX], omap_findclk(s, "dspxor_ck"));
|
3990 | d8f699cb | balrog | |
3991 | 60fe76e3 | Avi Kivity | s->led[0] = omap_lpg_init(system_memory,
|
3992 | 60fe76e3 | Avi Kivity | 0xfffbd000, omap_findclk(s, "clk32-kHz")); |
3993 | 60fe76e3 | Avi Kivity | s->led[1] = omap_lpg_init(system_memory,
|
3994 | 60fe76e3 | Avi Kivity | 0xfffbd800, omap_findclk(s, "clk32-kHz")); |
3995 | f9d43072 | balrog | |
3996 | 02645926 | balrog | /* Register mappings not currenlty implemented:
|
3997 | 02645926 | balrog | * MCSI2 Comm fffb2000 - fffb27ff (not mapped on OMAP310)
|
3998 | 02645926 | balrog | * MCSI1 Bluetooth fffb2800 - fffb2fff (not mapped on OMAP310)
|
3999 | 02645926 | balrog | * USB W2FC fffb4000 - fffb47ff
|
4000 | 02645926 | balrog | * Camera Interface fffb6800 - fffb6fff
|
4001 | 02645926 | balrog | * USB Host fffba000 - fffba7ff
|
4002 | 02645926 | balrog | * FAC fffba800 - fffbafff
|
4003 | 02645926 | balrog | * HDQ/1-Wire fffbc000 - fffbc7ff
|
4004 | b854bc19 | balrog | * TIPB switches fffbc800 - fffbcfff
|
4005 | 02645926 | balrog | * Mailbox fffcf000 - fffcf7ff
|
4006 | 02645926 | balrog | * Local bus IF fffec100 - fffec1ff
|
4007 | 02645926 | balrog | * Local bus MMU fffec200 - fffec2ff
|
4008 | 02645926 | balrog | * DSP MMU fffed200 - fffed2ff
|
4009 | 02645926 | balrog | */
|
4010 | 02645926 | balrog | |
4011 | 763b946c | Avi Kivity | omap_setup_dsp_mapping(system_memory, omap15xx_dsp_mm); |
4012 | 60fe76e3 | Avi Kivity | omap_setup_mpui_io(system_memory, s); |
4013 | cf965d24 | balrog | |
4014 | a08d4367 | Jan Kiszka | qemu_register_reset(omap1_mpu_reset, s); |
4015 | c3d2689d | balrog | |
4016 | c3d2689d | balrog | return s;
|
4017 | c3d2689d | balrog | } |