14 #define BAUD_RATE 19200
17 #define PORT_NAME "COM4:"
19 #define PORT_NAME "/dev/ttyUSB0"
22 void usage(const char * name)
24 loge("Usage: %s [-b baud] [-p port] [-i] [-v] {file.hex}\n", name);
25 loge("-b baud Set baudrate (default: %d)\n", BAUD_RATE);
26 loge("-p port Set serial port (default: %s)\n", PORT_NAME);
27 loge("-i ID Only mode.\n");
28 loge("-v Verify after write\n");
32 #define MIN(a,b) ((a)<(b)?(a):(b))
34 int bitmask(int value)
37 if (value >= (1<<1)) out |= 1;
38 if (value >= (1<<2)) out |= 1<<1;
39 if (value >= (1<<3)) out |= 1<<2;
40 if (value >= (1<<4)) out |= 1<<3;
41 if (value >= (1<<5)) out |= 1<<4;
42 if (value >= (1<<6)) out |= 1<<5;
43 if (value >= (1<<7)) out |= 1<<6;
44 if (value >= (1<<8)) out |= 1<<7;
45 if (value >= (1<<9)) out |= 1<<8;
46 if (value >= (1<<10)) out |= 1<<9;
51 * This routine writes a memory plan out to the device
53 int update_mem(port_t * pt, const devid_t * dev, uint16_t maxmem, mem_t * ram, int verify)
56 uint8_t buff[1024]; // scratch space
58 for (block=ram; block != NULL; block=block->next) {
59 int bstart = block->start / 2;
61 /* skip config words, we cant write them anyway */
62 if (bstart >= 0x8000) {
63 logd("UpdateMem: skip config block @ %04x", bstart);
68 uint8_t * p = block->bytes;
69 int left = block->len;
70 uint16_t addr = bstart;
71 int rowlen = dev->rowsize * 2;
72 logd("UpdateMem: new block %d bytes @ %04x", block->len, bstart);
78 memset(buff, 255, sizeof(buff));
80 /* first row, align the start */
81 if (addr % dev->rowsize != 0) {
82 addr &= ~bitmask(dev->rowsize);
83 off = (bstart - addr) * 2;
85 logd("UpdateMem: realigning %04X to %04X", bstart, addr);
91 logd("UpdateMem: Preparing %d bytes @ %04X", len, addr);
93 /* partial row write, read first */
94 if (off != 0 || len < rowlen) {
95 logd("UpdateMem: Read %d words @ %04x", dev->rowsize, addr);
96 if (loader_readmem(pt, addr, buff, dev->rowsize)) {
97 loge("UpdateMem: Aborting on failed read");
100 print_memory(addr, buff, dev->rowsize);
103 /* update with new values */
104 memcpy(&buff[off], p, len);
107 logd("UpdateMem: Writing %d words @ %04x", dev->rowsize, addr);
108 print_memory(addr, buff, dev->rowsize);
109 if (loader_writemem(pt, addr, buff, dev->rowsize)) {
110 loge("UpdateMem: Aborting on failed write");
116 logd("UpdateMem: Verify %d words @ %04x", dev->rowsize, addr);
117 if (loader_readmem(pt, addr, again, dev->rowsize)) {
118 loge("UpdateMem: Aborting on failed read");
121 print_memory(addr, again, dev->rowsize);
122 for (int i=0; i<rowlen; i++) {
123 if (again[i] != buff[i]) {
124 loge("UpdateMem: Verify failed on block 0x%04X", addr);
133 addr += dev->rowsize;
139 int main(int argc, char **argv)
143 int baud = BAUD_RATE;
147 while ((opt=getopt(argc, argv, "h?b:p:ivd"))!=-1) {
153 if (port) free(port);
154 port = strdup(optarg);
173 if (port == NULL) port = PORT_NAME;
175 if (!idonly && optind >= argc) {
176 loge("Error: missing hexfile");
184 if ((fd = fopen(argv[optind], "r"))==NULL) {
185 loge("Error opening %s: %s", argv[optind], strerror(errno));
191 logd("Memory Summary :-");
195 logd("open serial port %s at %d baud", port, baud);
196 port_t * pt = serial_open(port, baud);
203 if (loader_connect(pt, &maxmem, &devid)) {
207 const devid_t * dev = devid_to_info(devid);
210 logi("Device ID: %04X", devid);
211 logi(" Free Mem: %d words available", maxmem);
213 logi(" Dev Name: %s", dev->name );
214 logi(" Max Mem: %d", dev->memsize );
219 if (dev) logd("Device Name: %s", dev->name);
221 /* check that the selected program will fit on this device */
222 if (makesafe_mem(&ram, maxmem)) {
226 logd("After re-organisation");
229 /* now write the updated memory plan to the device */
230 if (!update_mem(pt, dev, maxmem, ram, verify)) {
232 logi("Device Write (and Verify) Complete");
234 logi("Device Write Complete");