]>
Commit | Line | Data |
---|---|---|
a541f297 FB |
1 | /* |
2 | * QEMU M48T59 NVRAM emulation for PPC PREP platform | |
3 | * | |
4 | * Copyright (c) 2003-2004 Jocelyn Mayer | |
5 | * | |
6 | * Permission is hereby granted, free of charge, to any person obtaining a copy | |
7 | * of this software and associated documentation files (the "Software"), to deal | |
8 | * in the Software without restriction, including without limitation the rights | |
9 | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell | |
10 | * copies of the Software, and to permit persons to whom the Software is | |
11 | * furnished to do so, subject to the following conditions: | |
12 | * | |
13 | * The above copyright notice and this permission notice shall be included in | |
14 | * all copies or substantial portions of the Software. | |
15 | * | |
16 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | |
17 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | |
18 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL | |
19 | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER | |
20 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, | |
21 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN | |
22 | * THE SOFTWARE. | |
23 | */ | |
a541f297 | 24 | #include "vl.h" |
c5df018e | 25 | #include "m48t59.h" |
a541f297 | 26 | |
13ab5daa | 27 | //#define DEBUG_NVRAM |
a541f297 | 28 | |
13ab5daa | 29 | #if defined(DEBUG_NVRAM) |
a541f297 FB |
30 | #define NVRAM_PRINTF(fmt, args...) do { printf(fmt , ##args); } while (0) |
31 | #else | |
32 | #define NVRAM_PRINTF(fmt, args...) do { } while (0) | |
33 | #endif | |
34 | ||
c5df018e | 35 | struct m48t59_t { |
a541f297 FB |
36 | /* Hardware parameters */ |
37 | int IRQ; | |
e1bb04f7 FB |
38 | int mem_index; |
39 | uint32_t mem_base; | |
a541f297 FB |
40 | uint32_t io_base; |
41 | uint16_t size; | |
42 | /* RTC management */ | |
43 | time_t time_offset; | |
44 | time_t stop_time; | |
45 | /* Alarm & watchdog */ | |
46 | time_t alarm; | |
47 | struct QEMUTimer *alrm_timer; | |
48 | struct QEMUTimer *wd_timer; | |
49 | /* NVRAM storage */ | |
13ab5daa | 50 | uint8_t lock; |
a541f297 FB |
51 | uint16_t addr; |
52 | uint8_t *buffer; | |
c5df018e | 53 | }; |
a541f297 FB |
54 | |
55 | /* Fake timer functions */ | |
56 | /* Generic helpers for BCD */ | |
57 | static inline uint8_t toBCD (uint8_t value) | |
58 | { | |
59 | return (((value / 10) % 10) << 4) | (value % 10); | |
60 | } | |
61 | ||
62 | static inline uint8_t fromBCD (uint8_t BCD) | |
63 | { | |
64 | return ((BCD >> 4) * 10) + (BCD & 0x0F); | |
65 | } | |
66 | ||
67 | /* RTC management helpers */ | |
68 | static void get_time (m48t59_t *NVRAM, struct tm *tm) | |
69 | { | |
70 | time_t t; | |
71 | ||
72 | t = time(NULL) + NVRAM->time_offset; | |
d157e205 FB |
73 | #ifdef _WIN32 |
74 | memcpy(tm,localtime(&t),sizeof(*tm)); | |
75 | #else | |
76 | localtime_r (&t, tm) ; | |
77 | #endif | |
a541f297 FB |
78 | } |
79 | ||
80 | static void set_time (m48t59_t *NVRAM, struct tm *tm) | |
81 | { | |
82 | time_t now, new_time; | |
83 | ||
84 | new_time = mktime(tm); | |
85 | now = time(NULL); | |
86 | NVRAM->time_offset = new_time - now; | |
87 | } | |
88 | ||
89 | /* Alarm management */ | |
90 | static void alarm_cb (void *opaque) | |
91 | { | |
92 | struct tm tm, tm_now; | |
93 | uint64_t next_time; | |
94 | m48t59_t *NVRAM = opaque; | |
95 | ||
96 | pic_set_irq(NVRAM->IRQ, 1); | |
97 | if ((NVRAM->buffer[0x1FF5] & 0x80) == 0 && | |
98 | (NVRAM->buffer[0x1FF4] & 0x80) == 0 && | |
99 | (NVRAM->buffer[0x1FF3] & 0x80) == 0 && | |
100 | (NVRAM->buffer[0x1FF2] & 0x80) == 0) { | |
101 | /* Repeat once a month */ | |
102 | get_time(NVRAM, &tm_now); | |
103 | memcpy(&tm, &tm_now, sizeof(struct tm)); | |
104 | tm.tm_mon++; | |
105 | if (tm.tm_mon == 13) { | |
106 | tm.tm_mon = 1; | |
107 | tm.tm_year++; | |
108 | } | |
109 | next_time = mktime(&tm); | |
110 | } else if ((NVRAM->buffer[0x1FF5] & 0x80) != 0 && | |
111 | (NVRAM->buffer[0x1FF4] & 0x80) == 0 && | |
112 | (NVRAM->buffer[0x1FF3] & 0x80) == 0 && | |
113 | (NVRAM->buffer[0x1FF2] & 0x80) == 0) { | |
114 | /* Repeat once a day */ | |
115 | next_time = 24 * 60 * 60 + mktime(&tm_now); | |
116 | } else if ((NVRAM->buffer[0x1FF5] & 0x80) != 0 && | |
117 | (NVRAM->buffer[0x1FF4] & 0x80) != 0 && | |
118 | (NVRAM->buffer[0x1FF3] & 0x80) == 0 && | |
119 | (NVRAM->buffer[0x1FF2] & 0x80) == 0) { | |
120 | /* Repeat once an hour */ | |
121 | next_time = 60 * 60 + mktime(&tm_now); | |
122 | } else if ((NVRAM->buffer[0x1FF5] & 0x80) != 0 && | |
123 | (NVRAM->buffer[0x1FF4] & 0x80) != 0 && | |
124 | (NVRAM->buffer[0x1FF3] & 0x80) != 0 && | |
125 | (NVRAM->buffer[0x1FF2] & 0x80) == 0) { | |
126 | /* Repeat once a minute */ | |
127 | next_time = 60 + mktime(&tm_now); | |
128 | } else { | |
129 | /* Repeat once a second */ | |
130 | next_time = 1 + mktime(&tm_now); | |
131 | } | |
132 | qemu_mod_timer(NVRAM->alrm_timer, next_time * 1000); | |
133 | pic_set_irq(NVRAM->IRQ, 0); | |
134 | } | |
135 | ||
136 | ||
137 | static void get_alarm (m48t59_t *NVRAM, struct tm *tm) | |
138 | { | |
d157e205 FB |
139 | #ifdef _WIN32 |
140 | memcpy(tm,localtime(&NVRAM->alarm),sizeof(*tm)); | |
141 | #else | |
142 | localtime_r (&NVRAM->alarm, tm); | |
143 | #endif | |
a541f297 FB |
144 | } |
145 | ||
146 | static void set_alarm (m48t59_t *NVRAM, struct tm *tm) | |
147 | { | |
148 | NVRAM->alarm = mktime(tm); | |
149 | if (NVRAM->alrm_timer != NULL) { | |
150 | qemu_del_timer(NVRAM->alrm_timer); | |
151 | NVRAM->alrm_timer = NULL; | |
152 | } | |
153 | if (NVRAM->alarm - time(NULL) > 0) | |
154 | qemu_mod_timer(NVRAM->alrm_timer, NVRAM->alarm * 1000); | |
155 | } | |
156 | ||
157 | /* Watchdog management */ | |
158 | static void watchdog_cb (void *opaque) | |
159 | { | |
160 | m48t59_t *NVRAM = opaque; | |
161 | ||
162 | NVRAM->buffer[0x1FF0] |= 0x80; | |
163 | if (NVRAM->buffer[0x1FF7] & 0x80) { | |
164 | NVRAM->buffer[0x1FF7] = 0x00; | |
165 | NVRAM->buffer[0x1FFC] &= ~0x40; | |
13ab5daa | 166 | /* May it be a hw CPU Reset instead ? */ |
d7d02e3c | 167 | qemu_system_reset_request(); |
a541f297 FB |
168 | } else { |
169 | pic_set_irq(NVRAM->IRQ, 1); | |
170 | pic_set_irq(NVRAM->IRQ, 0); | |
171 | } | |
172 | } | |
173 | ||
174 | static void set_up_watchdog (m48t59_t *NVRAM, uint8_t value) | |
175 | { | |
176 | uint64_t interval; /* in 1/16 seconds */ | |
177 | ||
178 | if (NVRAM->wd_timer != NULL) { | |
179 | qemu_del_timer(NVRAM->wd_timer); | |
180 | NVRAM->wd_timer = NULL; | |
181 | } | |
182 | NVRAM->buffer[0x1FF0] &= ~0x80; | |
183 | if (value != 0) { | |
184 | interval = (1 << (2 * (value & 0x03))) * ((value >> 2) & 0x1F); | |
185 | qemu_mod_timer(NVRAM->wd_timer, ((uint64_t)time(NULL) * 1000) + | |
186 | ((interval * 1000) >> 4)); | |
187 | } | |
188 | } | |
189 | ||
190 | /* Direct access to NVRAM */ | |
c5df018e | 191 | void m48t59_write (m48t59_t *NVRAM, uint32_t val) |
a541f297 | 192 | { |
a541f297 FB |
193 | struct tm tm; |
194 | int tmp; | |
195 | ||
196 | if (NVRAM->addr > 0x1FF8 && NVRAM->addr < 0x2000) | |
197 | NVRAM_PRINTF("%s: 0x%08x => 0x%08x\n", __func__, NVRAM->addr, val); | |
198 | switch (NVRAM->addr) { | |
199 | case 0x1FF0: | |
200 | /* flags register : read-only */ | |
201 | break; | |
202 | case 0x1FF1: | |
203 | /* unused */ | |
204 | break; | |
205 | case 0x1FF2: | |
206 | /* alarm seconds */ | |
207 | tmp = fromBCD(val & 0x7F); | |
208 | if (tmp >= 0 && tmp <= 59) { | |
209 | get_alarm(NVRAM, &tm); | |
210 | tm.tm_sec = tmp; | |
211 | NVRAM->buffer[0x1FF2] = val; | |
212 | set_alarm(NVRAM, &tm); | |
213 | } | |
214 | break; | |
215 | case 0x1FF3: | |
216 | /* alarm minutes */ | |
217 | tmp = fromBCD(val & 0x7F); | |
218 | if (tmp >= 0 && tmp <= 59) { | |
219 | get_alarm(NVRAM, &tm); | |
220 | tm.tm_min = tmp; | |
221 | NVRAM->buffer[0x1FF3] = val; | |
222 | set_alarm(NVRAM, &tm); | |
223 | } | |
224 | break; | |
225 | case 0x1FF4: | |
226 | /* alarm hours */ | |
227 | tmp = fromBCD(val & 0x3F); | |
228 | if (tmp >= 0 && tmp <= 23) { | |
229 | get_alarm(NVRAM, &tm); | |
230 | tm.tm_hour = tmp; | |
231 | NVRAM->buffer[0x1FF4] = val; | |
232 | set_alarm(NVRAM, &tm); | |
233 | } | |
234 | break; | |
235 | case 0x1FF5: | |
236 | /* alarm date */ | |
237 | tmp = fromBCD(val & 0x1F); | |
238 | if (tmp != 0) { | |
239 | get_alarm(NVRAM, &tm); | |
240 | tm.tm_mday = tmp; | |
241 | NVRAM->buffer[0x1FF5] = val; | |
242 | set_alarm(NVRAM, &tm); | |
243 | } | |
244 | break; | |
245 | case 0x1FF6: | |
246 | /* interrupts */ | |
247 | NVRAM->buffer[0x1FF6] = val; | |
248 | break; | |
249 | case 0x1FF7: | |
250 | /* watchdog */ | |
251 | NVRAM->buffer[0x1FF7] = val; | |
252 | set_up_watchdog(NVRAM, val); | |
253 | break; | |
254 | case 0x1FF8: | |
255 | /* control */ | |
256 | NVRAM->buffer[0x1FF8] = (val & ~0xA0) | 0x90; | |
257 | break; | |
258 | case 0x1FF9: | |
259 | /* seconds (BCD) */ | |
260 | tmp = fromBCD(val & 0x7F); | |
261 | if (tmp >= 0 && tmp <= 59) { | |
262 | get_time(NVRAM, &tm); | |
263 | tm.tm_sec = tmp; | |
264 | set_time(NVRAM, &tm); | |
265 | } | |
266 | if ((val & 0x80) ^ (NVRAM->buffer[0x1FF9] & 0x80)) { | |
267 | if (val & 0x80) { | |
268 | NVRAM->stop_time = time(NULL); | |
269 | } else { | |
270 | NVRAM->time_offset += NVRAM->stop_time - time(NULL); | |
271 | NVRAM->stop_time = 0; | |
272 | } | |
273 | } | |
274 | NVRAM->buffer[0x1FF9] = val & 0x80; | |
275 | break; | |
276 | case 0x1FFA: | |
277 | /* minutes (BCD) */ | |
278 | tmp = fromBCD(val & 0x7F); | |
279 | if (tmp >= 0 && tmp <= 59) { | |
280 | get_time(NVRAM, &tm); | |
281 | tm.tm_min = tmp; | |
282 | set_time(NVRAM, &tm); | |
283 | } | |
284 | break; | |
285 | case 0x1FFB: | |
286 | /* hours (BCD) */ | |
287 | tmp = fromBCD(val & 0x3F); | |
288 | if (tmp >= 0 && tmp <= 23) { | |
289 | get_time(NVRAM, &tm); | |
290 | tm.tm_hour = tmp; | |
291 | set_time(NVRAM, &tm); | |
292 | } | |
293 | break; | |
294 | case 0x1FFC: | |
295 | /* day of the week / century */ | |
296 | tmp = fromBCD(val & 0x07); | |
297 | get_time(NVRAM, &tm); | |
298 | tm.tm_wday = tmp; | |
299 | set_time(NVRAM, &tm); | |
300 | NVRAM->buffer[0x1FFC] = val & 0x40; | |
301 | break; | |
302 | case 0x1FFD: | |
303 | /* date */ | |
304 | tmp = fromBCD(val & 0x1F); | |
305 | if (tmp != 0) { | |
306 | get_time(NVRAM, &tm); | |
307 | tm.tm_mday = tmp; | |
308 | set_time(NVRAM, &tm); | |
309 | } | |
310 | break; | |
311 | case 0x1FFE: | |
312 | /* month */ | |
313 | tmp = fromBCD(val & 0x1F); | |
314 | if (tmp >= 1 && tmp <= 12) { | |
315 | get_time(NVRAM, &tm); | |
316 | tm.tm_mon = tmp - 1; | |
317 | set_time(NVRAM, &tm); | |
318 | } | |
319 | break; | |
320 | case 0x1FFF: | |
321 | /* year */ | |
322 | tmp = fromBCD(val); | |
323 | if (tmp >= 0 && tmp <= 99) { | |
324 | get_time(NVRAM, &tm); | |
325 | tm.tm_year = fromBCD(val); | |
326 | set_time(NVRAM, &tm); | |
327 | } | |
328 | break; | |
329 | default: | |
13ab5daa FB |
330 | /* Check lock registers state */ |
331 | if (NVRAM->addr >= 0x20 && NVRAM->addr <= 0x2F && (NVRAM->lock & 1)) | |
332 | break; | |
333 | if (NVRAM->addr >= 0x30 && NVRAM->addr <= 0x3F && (NVRAM->lock & 2)) | |
334 | break; | |
a541f297 FB |
335 | if (NVRAM->addr < 0x1FF0 || |
336 | (NVRAM->addr > 0x1FFF && NVRAM->addr < NVRAM->size)) { | |
337 | NVRAM->buffer[NVRAM->addr] = val & 0xFF; | |
338 | } | |
339 | break; | |
340 | } | |
341 | } | |
342 | ||
c5df018e | 343 | uint32_t m48t59_read (m48t59_t *NVRAM) |
a541f297 | 344 | { |
a541f297 FB |
345 | struct tm tm; |
346 | uint32_t retval = 0xFF; | |
347 | ||
348 | switch (NVRAM->addr) { | |
349 | case 0x1FF0: | |
350 | /* flags register */ | |
351 | goto do_read; | |
352 | case 0x1FF1: | |
353 | /* unused */ | |
354 | retval = 0; | |
355 | break; | |
356 | case 0x1FF2: | |
357 | /* alarm seconds */ | |
358 | goto do_read; | |
359 | case 0x1FF3: | |
360 | /* alarm minutes */ | |
361 | goto do_read; | |
362 | case 0x1FF4: | |
363 | /* alarm hours */ | |
364 | goto do_read; | |
365 | case 0x1FF5: | |
366 | /* alarm date */ | |
367 | goto do_read; | |
368 | case 0x1FF6: | |
369 | /* interrupts */ | |
370 | goto do_read; | |
371 | case 0x1FF7: | |
372 | /* A read resets the watchdog */ | |
373 | set_up_watchdog(NVRAM, NVRAM->buffer[0x1FF7]); | |
374 | goto do_read; | |
375 | case 0x1FF8: | |
376 | /* control */ | |
377 | goto do_read; | |
378 | case 0x1FF9: | |
379 | /* seconds (BCD) */ | |
380 | get_time(NVRAM, &tm); | |
381 | retval = (NVRAM->buffer[0x1FF9] & 0x80) | toBCD(tm.tm_sec); | |
382 | break; | |
383 | case 0x1FFA: | |
384 | /* minutes (BCD) */ | |
385 | get_time(NVRAM, &tm); | |
386 | retval = toBCD(tm.tm_min); | |
387 | break; | |
388 | case 0x1FFB: | |
389 | /* hours (BCD) */ | |
390 | get_time(NVRAM, &tm); | |
391 | retval = toBCD(tm.tm_hour); | |
392 | break; | |
393 | case 0x1FFC: | |
394 | /* day of the week / century */ | |
395 | get_time(NVRAM, &tm); | |
396 | retval = NVRAM->buffer[0x1FFC] | tm.tm_wday; | |
397 | break; | |
398 | case 0x1FFD: | |
399 | /* date */ | |
400 | get_time(NVRAM, &tm); | |
401 | retval = toBCD(tm.tm_mday); | |
402 | break; | |
403 | case 0x1FFE: | |
404 | /* month */ | |
405 | get_time(NVRAM, &tm); | |
406 | retval = toBCD(tm.tm_mon + 1); | |
407 | break; | |
408 | case 0x1FFF: | |
409 | /* year */ | |
410 | get_time(NVRAM, &tm); | |
411 | retval = toBCD(tm.tm_year); | |
412 | break; | |
413 | default: | |
13ab5daa FB |
414 | /* Check lock registers state */ |
415 | if (NVRAM->addr >= 0x20 && NVRAM->addr <= 0x2F && (NVRAM->lock & 1)) | |
416 | break; | |
417 | if (NVRAM->addr >= 0x30 && NVRAM->addr <= 0x3F && (NVRAM->lock & 2)) | |
418 | break; | |
a541f297 FB |
419 | if (NVRAM->addr < 0x1FF0 || |
420 | (NVRAM->addr > 0x1FFF && NVRAM->addr < NVRAM->size)) { | |
421 | do_read: | |
422 | retval = NVRAM->buffer[NVRAM->addr]; | |
423 | } | |
424 | break; | |
425 | } | |
426 | if (NVRAM->addr > 0x1FF9 && NVRAM->addr < 0x2000) | |
427 | NVRAM_PRINTF("0x%08x <= 0x%08x\n", NVRAM->addr, retval); | |
428 | ||
429 | return retval; | |
430 | } | |
431 | ||
c5df018e | 432 | void m48t59_set_addr (m48t59_t *NVRAM, uint32_t addr) |
a541f297 | 433 | { |
a541f297 FB |
434 | NVRAM->addr = addr; |
435 | } | |
436 | ||
13ab5daa FB |
437 | void m48t59_toggle_lock (m48t59_t *NVRAM, int lock) |
438 | { | |
439 | NVRAM->lock ^= 1 << lock; | |
440 | } | |
441 | ||
a541f297 FB |
442 | /* IO access to NVRAM */ |
443 | static void NVRAM_writeb (void *opaque, uint32_t addr, uint32_t val) | |
444 | { | |
445 | m48t59_t *NVRAM = opaque; | |
446 | ||
447 | addr -= NVRAM->io_base; | |
13ab5daa | 448 | NVRAM_PRINTF("0x%08x => 0x%08x\n", addr, val); |
a541f297 FB |
449 | switch (addr) { |
450 | case 0: | |
451 | NVRAM->addr &= ~0x00FF; | |
452 | NVRAM->addr |= val; | |
453 | break; | |
454 | case 1: | |
455 | NVRAM->addr &= ~0xFF00; | |
456 | NVRAM->addr |= val << 8; | |
457 | break; | |
458 | case 3: | |
459 | m48t59_write(NVRAM, val); | |
460 | NVRAM->addr = 0x0000; | |
461 | break; | |
462 | default: | |
463 | break; | |
464 | } | |
465 | } | |
466 | ||
467 | static uint32_t NVRAM_readb (void *opaque, uint32_t addr) | |
468 | { | |
469 | m48t59_t *NVRAM = opaque; | |
13ab5daa | 470 | uint32_t retval; |
a541f297 | 471 | |
13ab5daa FB |
472 | addr -= NVRAM->io_base; |
473 | switch (addr) { | |
474 | case 3: | |
475 | retval = m48t59_read(NVRAM); | |
476 | break; | |
477 | default: | |
478 | retval = -1; | |
479 | break; | |
480 | } | |
481 | NVRAM_PRINTF("0x%08x <= 0x%08x\n", addr, retval); | |
a541f297 | 482 | |
13ab5daa | 483 | return retval; |
a541f297 FB |
484 | } |
485 | ||
e1bb04f7 FB |
486 | static void nvram_writeb (void *opaque, target_phys_addr_t addr, uint32_t value) |
487 | { | |
488 | m48t59_t *NVRAM = opaque; | |
489 | ||
490 | addr -= NVRAM->mem_base; | |
491 | if (addr < 0x1FF0) | |
492 | NVRAM->buffer[addr] = value; | |
493 | } | |
494 | ||
495 | static void nvram_writew (void *opaque, target_phys_addr_t addr, uint32_t value) | |
496 | { | |
497 | m48t59_t *NVRAM = opaque; | |
498 | ||
499 | addr -= NVRAM->mem_base; | |
500 | if (addr < 0x1FF0) { | |
501 | NVRAM->buffer[addr] = value >> 8; | |
502 | NVRAM->buffer[addr + 1] = value; | |
503 | } | |
504 | } | |
505 | ||
506 | static void nvram_writel (void *opaque, target_phys_addr_t addr, uint32_t value) | |
507 | { | |
508 | m48t59_t *NVRAM = opaque; | |
509 | ||
510 | addr -= NVRAM->mem_base; | |
511 | if (addr < 0x1FF0) { | |
512 | NVRAM->buffer[addr] = value >> 24; | |
513 | NVRAM->buffer[addr + 1] = value >> 16; | |
514 | NVRAM->buffer[addr + 2] = value >> 8; | |
515 | NVRAM->buffer[addr + 3] = value; | |
516 | } | |
517 | } | |
518 | ||
519 | static uint32_t nvram_readb (void *opaque, target_phys_addr_t addr) | |
520 | { | |
521 | m48t59_t *NVRAM = opaque; | |
522 | uint32_t retval = 0; | |
523 | ||
524 | addr -= NVRAM->mem_base; | |
525 | if (addr < 0x1FF0) | |
526 | retval = NVRAM->buffer[addr]; | |
527 | ||
528 | return retval; | |
529 | } | |
530 | ||
531 | static uint32_t nvram_readw (void *opaque, target_phys_addr_t addr) | |
532 | { | |
533 | m48t59_t *NVRAM = opaque; | |
534 | uint32_t retval = 0; | |
535 | ||
536 | addr -= NVRAM->mem_base; | |
537 | if (addr < 0x1FF0) { | |
538 | retval = NVRAM->buffer[addr] << 8; | |
539 | retval |= NVRAM->buffer[addr + 1]; | |
540 | } | |
541 | ||
542 | return retval; | |
543 | } | |
544 | ||
545 | static uint32_t nvram_readl (void *opaque, target_phys_addr_t addr) | |
546 | { | |
547 | m48t59_t *NVRAM = opaque; | |
548 | uint32_t retval = 0; | |
549 | ||
550 | addr -= NVRAM->mem_base; | |
551 | if (addr < 0x1FF0) { | |
552 | retval = NVRAM->buffer[addr] << 24; | |
553 | retval |= NVRAM->buffer[addr + 1] << 16; | |
554 | retval |= NVRAM->buffer[addr + 2] << 8; | |
555 | retval |= NVRAM->buffer[addr + 3]; | |
556 | } | |
557 | ||
558 | return retval; | |
559 | } | |
560 | ||
561 | static CPUWriteMemoryFunc *nvram_write[] = { | |
562 | &nvram_writeb, | |
563 | &nvram_writew, | |
564 | &nvram_writel, | |
565 | }; | |
566 | ||
567 | static CPUReadMemoryFunc *nvram_read[] = { | |
568 | &nvram_readb, | |
569 | &nvram_readw, | |
570 | &nvram_readl, | |
571 | }; | |
a541f297 | 572 | /* Initialisation routine */ |
e1bb04f7 FB |
573 | m48t59_t *m48t59_init (int IRQ, uint32_t mem_base, |
574 | uint32_t io_base, uint16_t size) | |
a541f297 | 575 | { |
c5df018e | 576 | m48t59_t *s; |
a541f297 | 577 | |
c5df018e FB |
578 | s = qemu_mallocz(sizeof(m48t59_t)); |
579 | if (!s) | |
a541f297 | 580 | return NULL; |
c5df018e FB |
581 | s->buffer = qemu_mallocz(size); |
582 | if (!s->buffer) { | |
583 | qemu_free(s); | |
584 | return NULL; | |
585 | } | |
586 | s->IRQ = IRQ; | |
587 | s->size = size; | |
e1bb04f7 | 588 | s->mem_base = mem_base; |
c5df018e FB |
589 | s->io_base = io_base; |
590 | s->addr = 0; | |
591 | register_ioport_read(io_base, 0x04, 1, NVRAM_readb, s); | |
592 | register_ioport_write(io_base, 0x04, 1, NVRAM_writeb, s); | |
e1bb04f7 FB |
593 | if (mem_base != 0) { |
594 | s->mem_index = cpu_register_io_memory(0, nvram_read, nvram_write, s); | |
595 | cpu_register_physical_memory(mem_base, 0x4000, s->mem_index); | |
596 | } | |
c5df018e FB |
597 | s->alrm_timer = qemu_new_timer(vm_clock, &alarm_cb, s); |
598 | s->wd_timer = qemu_new_timer(vm_clock, &watchdog_cb, s); | |
13ab5daa FB |
599 | s->lock = 0; |
600 | ||
c5df018e | 601 | return s; |
a541f297 | 602 | } |