]>
Commit | Line | Data |
---|---|---|
049f7adb MT |
1 | #include "rwhandler.h" |
2 | #include "ioport.h" | |
3 | #include "cpu-all.h" | |
4 | ||
049f7adb MT |
5 | #define RWHANDLER_WRITE(name, len, type) \ |
6 | static void name(void *opaque, type addr, uint32_t value) \ | |
7 | {\ | |
8 | struct ReadWriteHandler *handler = opaque;\ | |
9 | handler->write(handler, addr, value, len);\ | |
10 | } | |
11 | ||
12 | #define RWHANDLER_READ(name, len, type) \ | |
13 | static uint32_t name(void *opaque, type addr) \ | |
14 | { \ | |
15 | struct ReadWriteHandler *handler = opaque; \ | |
16 | return handler->read(handler, addr, len); \ | |
17 | } | |
18 | ||
19 | RWHANDLER_WRITE(cpu_io_memory_simple_writeb, 1, target_phys_addr_t); | |
20 | RWHANDLER_READ(cpu_io_memory_simple_readb, 1, target_phys_addr_t); | |
21 | RWHANDLER_WRITE(cpu_io_memory_simple_writew, 2, target_phys_addr_t); | |
22 | RWHANDLER_READ(cpu_io_memory_simple_readw, 2, target_phys_addr_t); | |
23 | RWHANDLER_WRITE(cpu_io_memory_simple_writel, 4, target_phys_addr_t); | |
24 | RWHANDLER_READ(cpu_io_memory_simple_readl, 4, target_phys_addr_t); | |
25 | ||
26 | static CPUWriteMemoryFunc * const cpu_io_memory_simple_write[] = { | |
27 | &cpu_io_memory_simple_writeb, | |
28 | &cpu_io_memory_simple_writew, | |
29 | &cpu_io_memory_simple_writel, | |
30 | }; | |
31 | ||
32 | static CPUReadMemoryFunc * const cpu_io_memory_simple_read[] = { | |
33 | &cpu_io_memory_simple_readb, | |
34 | &cpu_io_memory_simple_readw, | |
35 | &cpu_io_memory_simple_readl, | |
36 | }; | |
37 | ||
38 | int cpu_register_io_memory_simple(struct ReadWriteHandler *handler) | |
39 | { | |
40 | if (!handler->read || !handler->write) { | |
41 | return -1; | |
42 | } | |
43 | return cpu_register_io_memory(cpu_io_memory_simple_read, | |
44 | cpu_io_memory_simple_write, | |
45 | handler); | |
46 | } | |
47 | ||
48 | RWHANDLER_WRITE(ioport_simple_writeb, 1, uint32_t); | |
49 | RWHANDLER_READ(ioport_simple_readb, 1, uint32_t); | |
50 | RWHANDLER_WRITE(ioport_simple_writew, 2, uint32_t); | |
51 | RWHANDLER_READ(ioport_simple_readw, 2, uint32_t); | |
52 | RWHANDLER_WRITE(ioport_simple_writel, 4, uint32_t); | |
53 | RWHANDLER_READ(ioport_simple_readl, 4, uint32_t); | |
54 | ||
55 | int register_ioport_simple(ReadWriteHandler* handler, | |
56 | pio_addr_t start, int length, int size) | |
57 | { | |
58 | IOPortWriteFunc *write; | |
59 | IOPortReadFunc *read; | |
60 | int r; | |
61 | switch (size) { | |
62 | case 1: | |
63 | write = ioport_simple_writeb; | |
64 | read = ioport_simple_readb; | |
65 | break; | |
66 | case 2: | |
67 | write = ioport_simple_writew; | |
68 | read = ioport_simple_readw; | |
69 | break; | |
70 | default: | |
71 | write = ioport_simple_writel; | |
72 | read = ioport_simple_readl; | |
73 | } | |
74 | if (handler->write) { | |
75 | r = register_ioport_write(start, length, size, write, handler); | |
76 | if (r < 0) { | |
77 | return r; | |
78 | } | |
79 | } | |
80 | if (handler->read) { | |
81 | r = register_ioport_read(start, length, size, read, handler); | |
82 | if (r < 0) { | |
83 | return r; | |
84 | } | |
85 | } | |
86 | return 0; | |
87 | } |