1:
2:
3:
4:
5:
6:
7:
8:
9:
10:
11:
12:
13:
14:
15:
16:
17:
18:
19:
20:
21:
22:
23:
24:
25: #include "hw.h"
26: #include "ppc_mac.h"
27:
28: struct MacIONVRAMState {
29: target_phys_addr_t mem_base;
30: target_phys_addr_t size;
31: int mem_index;
32: uint8_t data[0x2000];
33: };
34:
35:
36: uint32_t macio_nvram_read (void *opaque, uint32_t addr)
37: {
38: MacIONVRAMState *s = opaque;
39: uint32_t ret;
40:
41:
42: if (addr < 0x2000)
43: ret = s->data[addr];
44: else
45: ret = -1;
46:
47: return ret;
48: }
49:
50: void macio_nvram_write (void *opaque, uint32_t addr, uint32_t val)
51: {
52: MacIONVRAMState *s = opaque;
53:
54:
55: if (addr < 0x2000)
56: s->data[addr] = val;
57: }
58:
59:
60: static void macio_nvram_writeb (void *opaque,
61: target_phys_addr_t addr, uint32_t value)
62: {
63: MacIONVRAMState *s = opaque;
64:
65: addr -= s->mem_base;
66: addr = (addr >> 4) & 0x1fff;
67: s->data[addr] = value;
68:
69: }
70:
71: static uint32_t macio_nvram_readb (void *opaque, target_phys_addr_t addr)
72: {
73: MacIONVRAMState *s = opaque;
74: uint32_t value;
75:
76: addr -= s->mem_base;
77: addr = (addr >> 4) & 0x1fff;
78: value = s->data[addr];
79:
80:
81: return value;
82: }
83:
84: static CPUWriteMemoryFunc *nvram_write[] = {
85: &macio_nvram_writeb,
86: &macio_nvram_writeb,
87: &macio_nvram_writeb,
88: };
89:
90: static CPUReadMemoryFunc *nvram_read[] = {
91: &macio_nvram_readb,
92: &macio_nvram_readb,
93: &macio_nvram_readb,
94: };
95:
96: MacIONVRAMState *macio_nvram_init (int *mem_index, target_phys_addr_t size)
97: {
98: MacIONVRAMState *s;
99:
100: s = qemu_mallocz(sizeof(MacIONVRAMState));
101: if (!s)
102: return NULL;
103: s->size = size;
104: s->mem_index = cpu_register_io_memory(0, nvram_read, nvram_write, s);
105: *mem_index = s->mem_index;
106:
107: return s;
108: }
109:
110: void macio_nvram_map (void *opaque, target_phys_addr_t mem_base)
111: {
112: MacIONVRAMState *s;
113:
114: s = opaque;
115: s->mem_base = mem_base;
116: cpu_register_physical_memory(mem_base, s->size, s->mem_index);
117: }
118:
119: static uint8_t nvram_chksum (const uint8_t *buf, int n)
120: {
121: int sum, i;
122: sum = 0;
123: for(i = 0; i < n; i++)
124: sum += buf[i];
125: return (sum & 0xff) + (sum >> 8);
126: }
127:
128:
129: void pmac_format_nvram_partition (MacIONVRAMState *nvr, int len)
130: {
131: uint8_t *buf;
132: char partition_name[12] = "wwwwwwwwwwww";
133:
134: buf = nvr->data;
135: buf[0] = 0x7f;
136: buf[1] = 0;
137: buf[2] = len >> 8;
138: buf[3] = len;
139: memcpy(buf + 4, partition_name, 12);
140: buf[1] = nvram_chksum(buf, 16);
141: }