14 #define BAUD_RATE 19200
16 #define STRINGIFY(n) #n
19 #define PORT_NAME STRINGIFY(DEFPORT)
21 #define PORT_NAME "/dev/ttyUSB0"
25 static void keypress(void)
27 printf("Press ENTER to exit\n");
31 static void keypress(void) {}
35 void usage(const char * name)
37 loge("Usage: %s [-b baud] [-p port] [-i] [-v] {file.hex}\n", name);
38 loge("-b baud Set baudrate (default: %d)\n", BAUD_RATE);
39 loge("-p port Set serial port (default: %s)\n", PORT_NAME);
40 loge("-i ID Only mode.\n");
41 loge("-v Verify after write\n");
45 #define MIN(a,b) ((a)<(b)?(a):(b))
47 int bitmask(int value)
50 if (value >= (1<<1)) out |= 1;
51 if (value >= (1<<2)) out |= 1<<1;
52 if (value >= (1<<3)) out |= 1<<2;
53 if (value >= (1<<4)) out |= 1<<3;
54 if (value >= (1<<5)) out |= 1<<4;
55 if (value >= (1<<6)) out |= 1<<5;
56 if (value >= (1<<7)) out |= 1<<6;
57 if (value >= (1<<8)) out |= 1<<7;
58 if (value >= (1<<9)) out |= 1<<8;
59 if (value >= (1<<10)) out |= 1<<9;
64 * This routine writes a memory plan out to the device
66 int update_mem(port_t * pt, const devid_t * dev, uint16_t maxmem, mem_t * ram, int verify)
69 uint8_t buff[1024]; // scratch space
71 for (block=ram; block != NULL; block=block->next) {
72 int bstart = block->start / 2;
74 /* skip config words, we cant write them anyway */
75 if (bstart >= 0x8000) {
76 logd("UpdateMem: skip config block @ %04x", bstart);
81 uint8_t * p = block->bytes;
82 int left = block->len;
83 uint16_t addr = bstart;
84 int rowlen = dev->rowsize * 2;
85 logd("UpdateMem: new block %d bytes @ %04x", block->len, bstart);
91 memset(buff, 255, sizeof(buff));
93 /* first row, align the start */
94 if (addr % dev->rowsize != 0) {
95 addr &= ~bitmask(dev->rowsize);
96 off = (bstart - addr) * 2;
98 logd("UpdateMem: realigning %04X to %04X", bstart, addr);
102 len = MIN(len, left);
104 logd("UpdateMem: Preparing %d bytes @ %04X", len, addr);
106 /* partial row write, read first */
107 if (off != 0 || len < rowlen) {
108 logd("UpdateMem: Read %d words @ %04x", dev->rowsize, addr);
109 if (loader_readmem(pt, addr, buff, dev->rowsize)) {
110 loge("UpdateMem: Aborting on failed read");
113 print_memory(addr, buff, dev->rowsize);
116 /* update with new values */
117 memcpy(&buff[off], p, len);
120 logd("UpdateMem: Writing %d words @ %04x", dev->rowsize, addr);
121 print_memory(addr, buff, dev->rowsize);
122 if (loader_writemem(pt, addr, buff, dev->rowsize)) {
123 loge("UpdateMem: Aborting on failed write");
129 logd("UpdateMem: Verify %d words @ %04x", dev->rowsize, addr);
130 if (loader_readmem(pt, addr, again, dev->rowsize)) {
131 loge("UpdateMem: Aborting on failed read");
134 print_memory(addr, again, dev->rowsize);
135 for (int i=0; i<rowlen; i++) {
136 if (again[i] != buff[i]) {
137 loge("UpdateMem: Verify failed on block 0x%04X", addr);
146 addr += dev->rowsize;
152 int main(int argc, char **argv)
156 int baud = BAUD_RATE;
160 while ((opt=getopt(argc, argv, "h?b:p:ivd"))!=-1) {
166 if (port) free(port);
167 port = strdup(optarg);
186 if (port == NULL) port = PORT_NAME;
188 if (!idonly && optind >= argc) {
189 loge("Error: missing hexfile");
198 if ((fd = fopen(argv[optind], "r"))==NULL) {
199 loge("Error opening %s: %s", argv[optind], strerror(errno));
206 logd("Memory Summary :-");
210 logd("open serial port %s at %d baud", port, baud);
211 port_t * pt = serial_open(port, baud);
219 if (loader_connect(pt, &maxmem, &devid)) {
224 const devid_t * dev = devid_to_info(devid);
227 logi("Device ID: %04X", devid);
228 logi(" Free Mem: %d words available", maxmem);
230 logi(" Dev Name: %s", dev->name );
231 logi(" Max Mem: %d", dev->memsize );
237 if (dev) logd("Device Name: %s", dev->name);
239 /* check that the selected program will fit on this device */
240 if (makesafe_mem(&ram, maxmem)) {
245 logd("After re-organisation");
248 /* now write the updated memory plan to the device */
249 if (!update_mem(pt, dev, maxmem, ram, verify)) {
251 logi("Device Write (and Verify) Complete");
253 logi("Device Write Complete");