Add access control support to qemu bridge helper
[qemu.git] / hw / tc58128.c
1 #include "hw.h"
2 #include "sh.h"
3 #include "loader.h"
4
5 #define CE1 0x0100
6 #define CE2 0x0200
7 #define RE 0x0400
8 #define WE 0x0800
9 #define ALE 0x1000
10 #define CLE 0x2000
11 #define RDY1 0x4000
12 #define RDY2 0x8000
13 #define RDY(n) ((n) == 0 ? RDY1 : RDY2)
14
15 typedef enum { WAIT, READ1, READ2, READ3 } state_t;
16
17 typedef struct {
18 uint8_t *flash_contents;
19 state_t state;
20 uint32_t address;
21 uint8_t address_cycle;
22 } tc58128_dev;
23
24 static tc58128_dev tc58128_devs[2];
25
26 #define FLASH_SIZE (16*1024*1024)
27
28 static void init_dev(tc58128_dev * dev, const char *filename)
29 {
30 int ret, blocks;
31
32 dev->state = WAIT;
33 dev->flash_contents = g_malloc(FLASH_SIZE);
34 memset(dev->flash_contents, 0xff, FLASH_SIZE);
35 if (filename) {
36 /* Load flash image skipping the first block */
37 ret = load_image(filename, dev->flash_contents + 528 * 32);
38 if (ret < 0) {
39 fprintf(stderr, "ret=%d\n", ret);
40 fprintf(stderr, "qemu: could not load flash image %s\n",
41 filename);
42 exit(1);
43 } else {
44 /* Build first block with number of blocks */
45 blocks = (ret + 528 * 32 - 1) / (528 * 32);
46 dev->flash_contents[0] = blocks & 0xff;
47 dev->flash_contents[1] = (blocks >> 8) & 0xff;
48 dev->flash_contents[2] = (blocks >> 16) & 0xff;
49 dev->flash_contents[3] = (blocks >> 24) & 0xff;
50 fprintf(stderr, "loaded %d bytes for %s into flash\n", ret,
51 filename);
52 }
53 }
54 }
55
56 static void handle_command(tc58128_dev * dev, uint8_t command)
57 {
58 switch (command) {
59 case 0xff:
60 fprintf(stderr, "reset flash device\n");
61 dev->state = WAIT;
62 break;
63 case 0x00:
64 fprintf(stderr, "read mode 1\n");
65 dev->state = READ1;
66 dev->address_cycle = 0;
67 break;
68 case 0x01:
69 fprintf(stderr, "read mode 2\n");
70 dev->state = READ2;
71 dev->address_cycle = 0;
72 break;
73 case 0x50:
74 fprintf(stderr, "read mode 3\n");
75 dev->state = READ3;
76 dev->address_cycle = 0;
77 break;
78 default:
79 fprintf(stderr, "unknown flash command 0x%02x\n", command);
80 abort();
81 }
82 }
83
84 static void handle_address(tc58128_dev * dev, uint8_t data)
85 {
86 switch (dev->state) {
87 case READ1:
88 case READ2:
89 case READ3:
90 switch (dev->address_cycle) {
91 case 0:
92 dev->address = data;
93 if (dev->state == READ2)
94 dev->address |= 0x100;
95 else if (dev->state == READ3)
96 dev->address |= 0x200;
97 break;
98 case 1:
99 dev->address += data * 528 * 0x100;
100 break;
101 case 2:
102 dev->address += data * 528;
103 fprintf(stderr, "address pointer in flash: 0x%08x\n",
104 dev->address);
105 break;
106 default:
107 /* Invalid data */
108 abort();
109 }
110 dev->address_cycle++;
111 break;
112 default:
113 abort();
114 }
115 }
116
117 static uint8_t handle_read(tc58128_dev * dev)
118 {
119 #if 0
120 if (dev->address % 0x100000 == 0)
121 fprintf(stderr, "reading flash at address 0x%08x\n", dev->address);
122 #endif
123 return dev->flash_contents[dev->address++];
124 }
125
126 /* We never mark the device as busy, so interrupts cannot be triggered
127 XXXXX */
128
129 static int tc58128_cb(uint16_t porta, uint16_t portb,
130 uint16_t * periph_pdtra, uint16_t * periph_portadir,
131 uint16_t * periph_pdtrb, uint16_t * periph_portbdir)
132 {
133 int dev;
134
135 if ((porta & CE1) == 0)
136 dev = 0;
137 else if ((porta & CE2) == 0)
138 dev = 1;
139 else
140 return 0; /* No device selected */
141
142 if ((porta & RE) && (porta & WE)) {
143 /* Nothing to do, assert ready and return to input state */
144 *periph_portadir &= 0xff00;
145 *periph_portadir |= RDY(dev);
146 *periph_pdtra |= RDY(dev);
147 return 1;
148 }
149
150 if (porta & CLE) {
151 /* Command */
152 assert((porta & WE) == 0);
153 handle_command(&tc58128_devs[dev], porta & 0x00ff);
154 } else if (porta & ALE) {
155 assert((porta & WE) == 0);
156 handle_address(&tc58128_devs[dev], porta & 0x00ff);
157 } else if ((porta & RE) == 0) {
158 *periph_portadir |= 0x00ff;
159 *periph_pdtra &= 0xff00;
160 *periph_pdtra |= handle_read(&tc58128_devs[dev]);
161 } else {
162 abort();
163 }
164 return 1;
165 }
166
167 static sh7750_io_device tc58128 = {
168 RE | WE, /* Port A triggers */
169 0, /* Port B triggers */
170 tc58128_cb /* Callback */
171 };
172
173 int tc58128_init(struct SH7750State *s, const char *zone1, const char *zone2)
174 {
175 init_dev(&tc58128_devs[0], zone1);
176 init_dev(&tc58128_devs[1], zone2);
177 return sh7750_register_io_device(s, &tc58128);
178 }