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 "qemu/osdep.h"
26#include "qapi/error.h"
27#include "qemu-common.h"
28#include "cpu.h"
29#include "hw/sysbus.h"
30#include "net/net.h"
31#include "hw/block/flash.h"
32#include "hw/boards.h"
33#include "hw/cris/etraxfs.h"
34#include "hw/loader.h"
35#include "elf.h"
36#include "boot.h"
37#include "sysemu/block-backend.h"
38#include "exec/address-spaces.h"
39#include "sysemu/qtest.h"
40#include "sysemu/sysemu.h"
41
42#define D(x)
43#define DNAND(x)
44
45struct nand_state_t
46{
47 DeviceState *nand;
48 MemoryRegion iomem;
49 unsigned int rdy:1;
50 unsigned int ale:1;
51 unsigned int cle:1;
52 unsigned int ce:1;
53};
54
55static struct nand_state_t nand_state;
56static uint64_t nand_read(void *opaque, hwaddr addr, unsigned size)
57{
58 struct nand_state_t *s = opaque;
59 uint32_t r;
60 int rdy;
61
62 r = nand_getio(s->nand);
63 nand_getpins(s->nand, &rdy);
64 s->rdy = rdy;
65
66 DNAND(printf("%s addr=%x r=%x\n", __func__, addr, r));
67 return r;
68}
69
70static void
71nand_write(void *opaque, hwaddr addr, uint64_t value,
72 unsigned size)
73{
74 struct nand_state_t *s = opaque;
75 int rdy;
76
77 DNAND(printf("%s addr=%x v=%x\n", __func__, addr, (unsigned)value));
78 nand_setpins(s->nand, s->cle, s->ale, s->ce, 1, 0);
79 nand_setio(s->nand, value);
80 nand_getpins(s->nand, &rdy);
81 s->rdy = rdy;
82}
83
84static const MemoryRegionOps nand_ops = {
85 .read = nand_read,
86 .write = nand_write,
87 .endianness = DEVICE_NATIVE_ENDIAN,
88};
89
90struct tempsensor_t
91{
92 unsigned int shiftreg;
93 unsigned int count;
94 enum {
95 ST_OUT, ST_IN, ST_Z
96 } state;
97
98 uint16_t regs[3];
99};
100
101static void tempsensor_clkedge(struct tempsensor_t *s,
102 unsigned int clk, unsigned int data_in)
103{
104 D(printf("%s clk=%d state=%d sr=%x\n", __func__,
105 clk, s->state, s->shiftreg));
106 if (s->count == 0) {
107 s->count = 16;
108 s->state = ST_OUT;
109 }
110 switch (s->state) {
111 case ST_OUT:
112
113 if (!clk) {
114 s->count--;
115 s->shiftreg <<= 1;
116 if (s->count == 0) {
117 s->shiftreg = 0;
118 s->state = ST_IN;
119 s->count = 16;
120 }
121 }
122 break;
123 case ST_Z:
124 if (clk) {
125 s->count--;
126 if (s->count == 0) {
127 s->shiftreg = 0;
128 s->state = ST_OUT;
129 s->count = 16;
130 }
131 }
132 break;
133 case ST_IN:
134
135 if (clk) {
136 s->count--;
137 s->shiftreg <<= 1;
138 s->shiftreg |= data_in & 1;
139 if (s->count == 0) {
140 D(printf("%s cfgreg=%x\n", __func__, s->shiftreg));
141 s->regs[0] = s->shiftreg;
142 s->state = ST_OUT;
143 s->count = 16;
144
145 if ((s->regs[0] & 0xff) == 0) {
146
147 s->shiftreg = 0x0b9f;
148 } else if ((s->regs[0] & 0xff) == 0xff) {
149
150 s->shiftreg = 0x8100;
151 } else
152 printf("Invalid tempsens state %x\n", s->regs[0]);
153 }
154 }
155 break;
156 }
157}
158
159
160#define RW_PA_DOUT 0x00
161#define R_PA_DIN 0x01
162#define RW_PA_OE 0x02
163#define RW_PD_DOUT 0x10
164#define R_PD_DIN 0x11
165#define RW_PD_OE 0x12
166
167static struct gpio_state_t
168{
169 MemoryRegion iomem;
170 struct nand_state_t *nand;
171 struct tempsensor_t tempsensor;
172 uint32_t regs[0x5c / 4];
173} gpio_state;
174
175static uint64_t gpio_read(void *opaque, hwaddr addr, unsigned size)
176{
177 struct gpio_state_t *s = opaque;
178 uint32_t r = 0;
179
180 addr >>= 2;
181 switch (addr)
182 {
183 case R_PA_DIN:
184 r = s->regs[RW_PA_DOUT] & s->regs[RW_PA_OE];
185
186
187 r |= s->nand->rdy << 7;
188 break;
189 case R_PD_DIN:
190 r = s->regs[RW_PD_DOUT] & s->regs[RW_PD_OE];
191
192
193 r |= (!!(s->tempsensor.shiftreg & 0x10000)) << 4;
194 break;
195
196 default:
197 r = s->regs[addr];
198 break;
199 }
200 return r;
201 D(printf("%s %x=%x\n", __func__, addr, r));
202}
203
204static void gpio_write(void *opaque, hwaddr addr, uint64_t value,
205 unsigned size)
206{
207 struct gpio_state_t *s = opaque;
208 D(printf("%s %x=%x\n", __func__, addr, (unsigned)value));
209
210 addr >>= 2;
211 switch (addr)
212 {
213 case RW_PA_DOUT:
214
215 s->nand->ale = !!(value & (1 << 6));
216 s->nand->cle = !!(value & (1 << 5));
217 s->nand->ce = !!(value & (1 << 4));
218
219 s->regs[addr] = value;
220 break;
221
222 case RW_PD_DOUT:
223
224 if ((s->regs[addr] ^ value) & 2)
225 tempsensor_clkedge(&s->tempsensor, !!(value & 2),
226 !!(value & 16));
227 s->regs[addr] = value;
228 break;
229
230 default:
231 s->regs[addr] = value;
232 break;
233 }
234}
235
236static const MemoryRegionOps gpio_ops = {
237 .read = gpio_read,
238 .write = gpio_write,
239 .endianness = DEVICE_NATIVE_ENDIAN,
240 .valid = {
241 .min_access_size = 4,
242 .max_access_size = 4,
243 },
244};
245
246#define INTMEM_SIZE (128 * 1024)
247
248static struct cris_load_info li;
249
250static
251void axisdev88_init(MachineState *machine)
252{
253 ram_addr_t ram_size = machine->ram_size;
254 const char *cpu_model = machine->cpu_model;
255 const char *kernel_filename = machine->kernel_filename;
256 const char *kernel_cmdline = machine->kernel_cmdline;
257 CRISCPU *cpu;
258 CPUCRISState *env;
259 DeviceState *dev;
260 SysBusDevice *s;
261 DriveInfo *nand;
262 qemu_irq irq[30], nmi[2];
263 void *etraxfs_dmac;
264 struct etraxfs_dma_client *dma_eth;
265 int i;
266 MemoryRegion *address_space_mem = get_system_memory();
267 MemoryRegion *phys_ram = g_new(MemoryRegion, 1);
268 MemoryRegion *phys_intmem = g_new(MemoryRegion, 1);
269
270
271 if (cpu_model == NULL) {
272 cpu_model = "crisv32";
273 }
274 cpu = cpu_cris_init(cpu_model);
275 env = &cpu->env;
276
277
278 memory_region_allocate_system_memory(phys_ram, NULL, "axisdev88.ram",
279 ram_size);
280 memory_region_add_subregion(address_space_mem, 0x40000000, phys_ram);
281
282
283
284 memory_region_init_ram(phys_intmem, NULL, "axisdev88.chipram", INTMEM_SIZE,
285 &error_fatal);
286 vmstate_register_ram_global(phys_intmem);
287 memory_region_add_subregion(address_space_mem, 0x38000000, phys_intmem);
288
289
290 nand = drive_get(IF_MTD, 0, 0);
291 nand_state.nand = nand_init(nand ? blk_by_legacy_dinfo(nand) : NULL,
292 NAND_MFR_STMICRO, 0x39);
293 memory_region_init_io(&nand_state.iomem, NULL, &nand_ops, &nand_state,
294 "nand", 0x05000000);
295 memory_region_add_subregion(address_space_mem, 0x10000000,
296 &nand_state.iomem);
297
298 gpio_state.nand = &nand_state;
299 memory_region_init_io(&gpio_state.iomem, NULL, &gpio_ops, &gpio_state,
300 "gpio", 0x5c);
301 memory_region_add_subregion(address_space_mem, 0x3001a000,
302 &gpio_state.iomem);
303
304
305 dev = qdev_create(NULL, "etraxfs,pic");
306
307 qdev_prop_set_ptr(dev, "interrupt_vector", &env->interrupt_vector);
308 qdev_init_nofail(dev);
309 s = SYS_BUS_DEVICE(dev);
310 sysbus_mmio_map(s, 0, 0x3001c000);
311 sysbus_connect_irq(s, 0, qdev_get_gpio_in(DEVICE(cpu), CRIS_CPU_IRQ));
312 sysbus_connect_irq(s, 1, qdev_get_gpio_in(DEVICE(cpu), CRIS_CPU_NMI));
313 for (i = 0; i < 30; i++) {
314 irq[i] = qdev_get_gpio_in(dev, i);
315 }
316 nmi[0] = qdev_get_gpio_in(dev, 30);
317 nmi[1] = qdev_get_gpio_in(dev, 31);
318
319 etraxfs_dmac = etraxfs_dmac_init(0x30000000, 10);
320 for (i = 0; i < 10; i++) {
321
322 etraxfs_dmac_connect(etraxfs_dmac, i, irq + 7 + i, i & 1);
323 }
324
325
326 dma_eth = g_malloc0(sizeof dma_eth[0] * 4);
327 etraxfs_eth_init(&nd_table[0], 0x30034000, 1, &dma_eth[0], &dma_eth[1]);
328 if (nb_nics > 1) {
329 etraxfs_eth_init(&nd_table[1], 0x30036000, 2, &dma_eth[2], &dma_eth[3]);
330 }
331
332
333 etraxfs_dmac_connect_client(etraxfs_dmac, 0, &dma_eth[0]);
334 etraxfs_dmac_connect_client(etraxfs_dmac, 1, &dma_eth[1]);
335 if (nb_nics > 1) {
336 etraxfs_dmac_connect_client(etraxfs_dmac, 6, &dma_eth[2]);
337 etraxfs_dmac_connect_client(etraxfs_dmac, 7, &dma_eth[3]);
338 }
339
340
341 sysbus_create_varargs("etraxfs,timer", 0x3001e000, irq[0x1b], nmi[1], NULL);
342 sysbus_create_varargs("etraxfs,timer", 0x3005e000, irq[0x1b], nmi[1], NULL);
343
344 for (i = 0; i < 4; i++) {
345 etraxfs_ser_create(0x30026000 + i * 0x2000, irq[0x14 + i], serial_hds[i]);
346 }
347
348 if (kernel_filename) {
349 li.image_filename = kernel_filename;
350 li.cmdline = kernel_cmdline;
351 cris_load_image(cpu, &li);
352 } else if (!qtest_enabled()) {
353 fprintf(stderr, "Kernel image must be specified\n");
354 exit(1);
355 }
356}
357
358static void axisdev88_machine_init(MachineClass *mc)
359{
360 mc->desc = "AXIS devboard 88";
361 mc->init = axisdev88_init;
362 mc->is_default = 1;
363}
364
365DEFINE_MACHINE("axis-dev88", axisdev88_machine_init)
366