root / hw / esp.c @ 6f7e9aec
History | View | Annotate | Download (4.7 kB)
1 | 6f7e9aec | bellard | /*
|
---|---|---|---|
2 | 6f7e9aec | bellard | * QEMU ESP emulation
|
3 | 6f7e9aec | bellard | *
|
4 | 6f7e9aec | bellard | * Copyright (c) 2005 Fabrice Bellard
|
5 | 6f7e9aec | bellard | *
|
6 | 6f7e9aec | bellard | * Permission is hereby granted, free of charge, to any person obtaining a copy
|
7 | 6f7e9aec | bellard | * of this software and associated documentation files (the "Software"), to deal
|
8 | 6f7e9aec | bellard | * in the Software without restriction, including without limitation the rights
|
9 | 6f7e9aec | bellard | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
10 | 6f7e9aec | bellard | * copies of the Software, and to permit persons to whom the Software is
|
11 | 6f7e9aec | bellard | * furnished to do so, subject to the following conditions:
|
12 | 6f7e9aec | bellard | *
|
13 | 6f7e9aec | bellard | * The above copyright notice and this permission notice shall be included in
|
14 | 6f7e9aec | bellard | * all copies or substantial portions of the Software.
|
15 | 6f7e9aec | bellard | *
|
16 | 6f7e9aec | bellard | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
17 | 6f7e9aec | bellard | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
18 | 6f7e9aec | bellard | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
19 | 6f7e9aec | bellard | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
20 | 6f7e9aec | bellard | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
21 | 6f7e9aec | bellard | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
22 | 6f7e9aec | bellard | * THE SOFTWARE.
|
23 | 6f7e9aec | bellard | */
|
24 | 6f7e9aec | bellard | #include "vl.h" |
25 | 6f7e9aec | bellard | |
26 | 6f7e9aec | bellard | /* debug ESP card */
|
27 | 6f7e9aec | bellard | #define DEBUG_ESP
|
28 | 6f7e9aec | bellard | |
29 | 6f7e9aec | bellard | #ifdef DEBUG_ESP
|
30 | 6f7e9aec | bellard | #define DPRINTF(fmt, args...) \
|
31 | 6f7e9aec | bellard | do { printf("ESP: " fmt , ##args); } while (0) |
32 | 6f7e9aec | bellard | #else
|
33 | 6f7e9aec | bellard | #define DPRINTF(fmt, args...)
|
34 | 6f7e9aec | bellard | #endif
|
35 | 6f7e9aec | bellard | |
36 | 6f7e9aec | bellard | #define ESPDMA_REGS 4 |
37 | 6f7e9aec | bellard | #define ESPDMA_MAXADDR (ESPDMA_REGS * 4 - 1) |
38 | 6f7e9aec | bellard | #define ESP_MAXREG 0x3f |
39 | 6f7e9aec | bellard | |
40 | 6f7e9aec | bellard | typedef struct ESPState { |
41 | 6f7e9aec | bellard | BlockDriverState **bd; |
42 | 6f7e9aec | bellard | uint8_t regs[ESP_MAXREG]; |
43 | 6f7e9aec | bellard | int irq;
|
44 | 6f7e9aec | bellard | uint32_t espdmaregs[ESPDMA_REGS]; |
45 | 6f7e9aec | bellard | } ESPState; |
46 | 6f7e9aec | bellard | |
47 | 6f7e9aec | bellard | static void esp_reset(void *opaque) |
48 | 6f7e9aec | bellard | { |
49 | 6f7e9aec | bellard | ESPState *s = opaque; |
50 | 6f7e9aec | bellard | memset(s->regs, 0, ESP_MAXREG);
|
51 | 6f7e9aec | bellard | s->regs[0x0e] = 0x4; // Indicate fas100a |
52 | 6f7e9aec | bellard | memset(s->espdmaregs, 0, ESPDMA_REGS * 4); |
53 | 6f7e9aec | bellard | } |
54 | 6f7e9aec | bellard | |
55 | 6f7e9aec | bellard | static uint32_t esp_mem_readb(void *opaque, target_phys_addr_t addr) |
56 | 6f7e9aec | bellard | { |
57 | 6f7e9aec | bellard | ESPState *s = opaque; |
58 | 6f7e9aec | bellard | uint32_t saddr; |
59 | 6f7e9aec | bellard | |
60 | 6f7e9aec | bellard | saddr = (addr & ESP_MAXREG) >> 2;
|
61 | 6f7e9aec | bellard | switch (saddr) {
|
62 | 6f7e9aec | bellard | default:
|
63 | 6f7e9aec | bellard | break;
|
64 | 6f7e9aec | bellard | } |
65 | 6f7e9aec | bellard | DPRINTF("esp: read reg[%d]: 0x%2.2x\n", saddr, s->regs[saddr]);
|
66 | 6f7e9aec | bellard | return s->regs[saddr];
|
67 | 6f7e9aec | bellard | } |
68 | 6f7e9aec | bellard | |
69 | 6f7e9aec | bellard | static void esp_mem_writeb(void *opaque, target_phys_addr_t addr, uint32_t val) |
70 | 6f7e9aec | bellard | { |
71 | 6f7e9aec | bellard | ESPState *s = opaque; |
72 | 6f7e9aec | bellard | uint32_t saddr; |
73 | 6f7e9aec | bellard | |
74 | 6f7e9aec | bellard | saddr = (addr & ESP_MAXREG) >> 2;
|
75 | 6f7e9aec | bellard | DPRINTF("esp: write reg[%d]: 0x%2.2x -> 0x%2.2x\n", saddr, s->regs[saddr], val);
|
76 | 6f7e9aec | bellard | switch (saddr) {
|
77 | 6f7e9aec | bellard | case 3: |
78 | 6f7e9aec | bellard | // Command
|
79 | 6f7e9aec | bellard | switch(val & 0x7f) { |
80 | 6f7e9aec | bellard | case 0: |
81 | 6f7e9aec | bellard | DPRINTF("esp: NOP (%2.2x)\n", val);
|
82 | 6f7e9aec | bellard | break;
|
83 | 6f7e9aec | bellard | case 2: |
84 | 6f7e9aec | bellard | DPRINTF("esp: Chip reset (%2.2x)\n", val);
|
85 | 6f7e9aec | bellard | esp_reset(s); |
86 | 6f7e9aec | bellard | break;
|
87 | 6f7e9aec | bellard | case 3: |
88 | 6f7e9aec | bellard | DPRINTF("esp: Bus reset (%2.2x)\n", val);
|
89 | 6f7e9aec | bellard | break;
|
90 | 6f7e9aec | bellard | case 0x1a: |
91 | 6f7e9aec | bellard | DPRINTF("esp: Set ATN (%2.2x)\n", val);
|
92 | 6f7e9aec | bellard | break;
|
93 | 6f7e9aec | bellard | case 0x42: |
94 | 6f7e9aec | bellard | DPRINTF("esp: Select with ATN (%2.2x)\n", val);
|
95 | 6f7e9aec | bellard | s->regs[4] = 0x1a; // Status: TCNT | TDONE | CMD |
96 | 6f7e9aec | bellard | s->regs[5] = 0x20; // Intr: Disconnect, nobody there |
97 | 6f7e9aec | bellard | s->regs[6] = 0x4; // Seq: Cmd done |
98 | 6f7e9aec | bellard | pic_set_irq(s->irq, 1);
|
99 | 6f7e9aec | bellard | break;
|
100 | 6f7e9aec | bellard | } |
101 | 6f7e9aec | bellard | break;
|
102 | 6f7e9aec | bellard | case 4 ... 7: |
103 | 6f7e9aec | bellard | case 9 ... 0xf: |
104 | 6f7e9aec | bellard | break;
|
105 | 6f7e9aec | bellard | default:
|
106 | 6f7e9aec | bellard | s->regs[saddr] = val; |
107 | 6f7e9aec | bellard | break;
|
108 | 6f7e9aec | bellard | } |
109 | 6f7e9aec | bellard | } |
110 | 6f7e9aec | bellard | |
111 | 6f7e9aec | bellard | static CPUReadMemoryFunc *esp_mem_read[3] = { |
112 | 6f7e9aec | bellard | esp_mem_readb, |
113 | 6f7e9aec | bellard | esp_mem_readb, |
114 | 6f7e9aec | bellard | esp_mem_readb, |
115 | 6f7e9aec | bellard | }; |
116 | 6f7e9aec | bellard | |
117 | 6f7e9aec | bellard | static CPUWriteMemoryFunc *esp_mem_write[3] = { |
118 | 6f7e9aec | bellard | esp_mem_writeb, |
119 | 6f7e9aec | bellard | esp_mem_writeb, |
120 | 6f7e9aec | bellard | esp_mem_writeb, |
121 | 6f7e9aec | bellard | }; |
122 | 6f7e9aec | bellard | |
123 | 6f7e9aec | bellard | static uint32_t espdma_mem_readl(void *opaque, target_phys_addr_t addr) |
124 | 6f7e9aec | bellard | { |
125 | 6f7e9aec | bellard | ESPState *s = opaque; |
126 | 6f7e9aec | bellard | uint32_t saddr; |
127 | 6f7e9aec | bellard | |
128 | 6f7e9aec | bellard | saddr = (addr & ESPDMA_MAXADDR) >> 2;
|
129 | 6f7e9aec | bellard | return s->espdmaregs[saddr];
|
130 | 6f7e9aec | bellard | } |
131 | 6f7e9aec | bellard | |
132 | 6f7e9aec | bellard | static void espdma_mem_writel(void *opaque, target_phys_addr_t addr, uint32_t val) |
133 | 6f7e9aec | bellard | { |
134 | 6f7e9aec | bellard | ESPState *s = opaque; |
135 | 6f7e9aec | bellard | uint32_t saddr; |
136 | 6f7e9aec | bellard | |
137 | 6f7e9aec | bellard | saddr = (addr & ESPDMA_MAXADDR) >> 2;
|
138 | 6f7e9aec | bellard | s->espdmaregs[saddr] = val; |
139 | 6f7e9aec | bellard | } |
140 | 6f7e9aec | bellard | |
141 | 6f7e9aec | bellard | static CPUReadMemoryFunc *espdma_mem_read[3] = { |
142 | 6f7e9aec | bellard | espdma_mem_readl, |
143 | 6f7e9aec | bellard | espdma_mem_readl, |
144 | 6f7e9aec | bellard | espdma_mem_readl, |
145 | 6f7e9aec | bellard | }; |
146 | 6f7e9aec | bellard | |
147 | 6f7e9aec | bellard | static CPUWriteMemoryFunc *espdma_mem_write[3] = { |
148 | 6f7e9aec | bellard | espdma_mem_writel, |
149 | 6f7e9aec | bellard | espdma_mem_writel, |
150 | 6f7e9aec | bellard | espdma_mem_writel, |
151 | 6f7e9aec | bellard | }; |
152 | 6f7e9aec | bellard | |
153 | 6f7e9aec | bellard | static void esp_save(QEMUFile *f, void *opaque) |
154 | 6f7e9aec | bellard | { |
155 | 6f7e9aec | bellard | ESPState *s = opaque; |
156 | 6f7e9aec | bellard | |
157 | 6f7e9aec | bellard | } |
158 | 6f7e9aec | bellard | |
159 | 6f7e9aec | bellard | static int esp_load(QEMUFile *f, void *opaque, int version_id) |
160 | 6f7e9aec | bellard | { |
161 | 6f7e9aec | bellard | ESPState *s = opaque; |
162 | 6f7e9aec | bellard | |
163 | 6f7e9aec | bellard | if (version_id != 1) |
164 | 6f7e9aec | bellard | return -EINVAL;
|
165 | 6f7e9aec | bellard | |
166 | 6f7e9aec | bellard | return 0; |
167 | 6f7e9aec | bellard | } |
168 | 6f7e9aec | bellard | |
169 | 6f7e9aec | bellard | void esp_init(BlockDriverState **bd, int irq, uint32_t espaddr, uint32_t espdaddr) |
170 | 6f7e9aec | bellard | { |
171 | 6f7e9aec | bellard | ESPState *s; |
172 | 6f7e9aec | bellard | int esp_io_memory, espdma_io_memory;
|
173 | 6f7e9aec | bellard | |
174 | 6f7e9aec | bellard | s = qemu_mallocz(sizeof(ESPState));
|
175 | 6f7e9aec | bellard | if (!s)
|
176 | 6f7e9aec | bellard | return;
|
177 | 6f7e9aec | bellard | |
178 | 6f7e9aec | bellard | s->bd = bd; |
179 | 6f7e9aec | bellard | s->irq = irq; |
180 | 6f7e9aec | bellard | |
181 | 6f7e9aec | bellard | esp_io_memory = cpu_register_io_memory(0, esp_mem_read, esp_mem_write, s);
|
182 | 6f7e9aec | bellard | cpu_register_physical_memory(espaddr, ESP_MAXREG*4, esp_io_memory);
|
183 | 6f7e9aec | bellard | |
184 | 6f7e9aec | bellard | espdma_io_memory = cpu_register_io_memory(0, espdma_mem_read, espdma_mem_write, s);
|
185 | 6f7e9aec | bellard | cpu_register_physical_memory(espdaddr, 16, espdma_io_memory);
|
186 | 6f7e9aec | bellard | |
187 | 6f7e9aec | bellard | esp_reset(s); |
188 | 6f7e9aec | bellard | |
189 | 6f7e9aec | bellard | register_savevm("esp", espaddr, 1, esp_save, esp_load, s); |
190 | 6f7e9aec | bellard | qemu_register_reset(esp_reset, s); |
191 | 6f7e9aec | bellard | } |