57 static void init_dev(tc58128_dev * dev, const char *filename)  in init_dev()  argument
61     dev->state = WAIT;  in init_dev()
62     dev->flash_contents = g_malloc(FLASH_SIZE);  in init_dev()
63     memset(dev->flash_contents, 0xff, FLASH_SIZE);  in init_dev()
66         ret = load_image_size(filename, dev->flash_contents + 528 * 32,  in init_dev()
76             dev->flash_contents[0] = blocks & 0xff;  in init_dev()
77             dev->flash_contents[1] = (blocks >> 8) & 0xff;  in init_dev()
78             dev->flash_contents[2] = (blocks >> 16) & 0xff;  in init_dev()
79             dev->flash_contents[3] = (blocks >> 24) & 0xff;  in init_dev()
86 static void handle_command(tc58128_dev * dev, uint8_t command)  in handle_command()  argument
91         dev->state = WAIT;  in handle_command()
95         dev->state = READ1;  in handle_command()
96         dev->address_cycle = 0;  in handle_command()
100         dev->state = READ2;  in handle_command()
101         dev->address_cycle = 0;  in handle_command()
105         dev->state = READ3;  in handle_command()
106         dev->address_cycle = 0;  in handle_command()
114 static void handle_address(tc58128_dev * dev, uint8_t data)  in handle_address()  argument
116     switch (dev->state) {  in handle_address()
120         switch (dev->address_cycle) {  in handle_address()
122             dev->address = data;  in handle_address()
123             if (dev->state == READ2)  in handle_address()
124                 dev->address |= 0x100;  in handle_address()
125             else if (dev->state == READ3)  in handle_address()
126                 dev->address |= 0x200;  in handle_address()
129             dev->address += data * 528 * 0x100;  in handle_address()
132             dev->address += data * 528;  in handle_address()
134                     dev->address);  in handle_address()
140         dev->address_cycle++;  in handle_address()
147 static uint8_t handle_read(tc58128_dev * dev)  in handle_read()  argument
150     if (dev->address % 0x100000 == 0)  in handle_read()
151         fprintf(stderr, "reading flash at address 0x%08x\n", dev->address);  in handle_read()
153     return dev->flash_contents[dev->address++];  in handle_read()
163     int dev;  in tc58128_cb()  local
166         dev = 0;  in tc58128_cb()
168         dev = 1;  in tc58128_cb()
175         *periph_portadir |= RDY(dev);  in tc58128_cb()
176         *periph_pdtra |= RDY(dev);  in tc58128_cb()
183         handle_command(&tc58128_devs[dev], porta & 0x00ff);  in tc58128_cb()
186         handle_address(&tc58128_devs[dev], porta & 0x00ff);  in tc58128_cb()
190         *periph_pdtra |= handle_read(&tc58128_devs[dev]);  in tc58128_cb()