14 #define BAUD_RATE 19200
15 #define PORT_NAME "/dev/ttyUSB0"
18 void usage(const char * name)
20 loge("Usage: %s [-b baud] [-p port] [-i] [-v] {file.hex}\n", name);
21 loge("-b baud Set baudrate (default: %d)\n", BAUD_RATE);
22 loge("-p port Set serial port (default: %s)\n", PORT_NAME);
23 loge("-i ID Only mode.\n");
24 loge("-v Verify after write\n");
28 #define MIN(a,b) ((a)<(b)?(a):(b))
30 int bitmask(int value)
33 if (value >= (1<<1)) out |= 1;
34 if (value >= (1<<2)) out |= 1<<1;
35 if (value >= (1<<3)) out |= 1<<2;
36 if (value >= (1<<4)) out |= 1<<3;
37 if (value >= (1<<5)) out |= 1<<4;
38 if (value >= (1<<6)) out |= 1<<5;
39 if (value >= (1<<7)) out |= 1<<6;
40 if (value >= (1<<8)) out |= 1<<7;
41 if (value >= (1<<9)) out |= 1<<8;
42 if (value >= (1<<10)) out |= 1<<9;
47 * This routine writes a memory plan out to the device
49 int update_mem(port_t * pt, const devid_t * dev, uint16_t maxmem, mem_t * ram, int verify)
52 uint8_t buff[1024]; // scratch space
54 for (block=ram; block != NULL; block=block->next) {
55 int bstart = block->start / 2;
57 /* skip config words, we cant write them anyway */
58 if (bstart >= 0x8000) {
59 logd("UpdateMem: skip config block @ %04x", bstart);
64 uint8_t * p = block->bytes;
65 int left = block->len;
66 uint16_t addr = bstart;
67 int rowlen = dev->rowsize * 2;
68 logd("UpdateMem: new block %d bytes @ %04x", block->len, bstart);
74 memset(buff, 255, sizeof(buff));
76 /* first row, align the start */
77 if (addr % dev->rowsize != 0) {
78 addr &= ~bitmask(dev->rowsize);
79 off = (bstart - addr) * 2;
81 logd("UpdateMem: realigning %04X to %04X", bstart, addr);
87 logd("UpdateMem: Preparing %d bytes @ %04X", len, addr);
89 /* partial row write, read first */
90 if (off != 0 || len < rowlen) {
91 logd("UpdateMem: Read %d words @ %04x", dev->rowsize, addr);
92 if (loader_readmem(pt, addr, buff, dev->rowsize)) {
93 loge("UpdateMem: Aborting on failed read");
96 print_memory(addr, buff, dev->rowsize);
99 /* update with new values */
100 memcpy(&buff[off], p, len);
103 logd("UpdateMem: Writing %d words @ %04x", dev->rowsize, addr);
104 print_memory(addr, buff, dev->rowsize);
105 if (loader_writemem(pt, addr, buff, dev->rowsize)) {
106 loge("UpdateMem: Aborting on failed write");
112 logd("UpdateMem: Verify %d words @ %04x", dev->rowsize, addr);
113 if (loader_readmem(pt, addr, again, dev->rowsize)) {
114 loge("UpdateMem: Aborting on failed read");
117 print_memory(addr, again, dev->rowsize);
118 for (int i=0; i<rowlen; i++) {
119 if (again[i] != buff[i]) {
120 loge("UpdateMem: Verify failed on block 0x%04X", addr);
129 addr += dev->rowsize;
135 int main(int argc, char **argv)
139 int baud = BAUD_RATE;
143 while ((opt=getopt(argc, argv, "h?b:p:ivd"))!=-1) {
149 if (port) free(port);
150 port = strdup(optarg);
169 if (port == NULL) port = PORT_NAME;
171 if (!idonly && optind >= argc) {
172 loge("Error: missing hexfile");
180 if ((fd = fopen(argv[optind], "r"))==NULL) {
181 loge("Error opening %s: %s", argv[optind], strerror(errno));
187 logd("Memory Summary :-");
191 logd("open serial port %s at %d baud", port, baud);
192 port_t * pt = serial_open(port, baud);
193 if (pt == NULL) return 1;
197 if (loader_connect(pt, &maxmem, &devid)) {
201 const devid_t * dev = devid_to_info(devid);
204 logi("Device ID: %04X", devid);
205 logi(" Free Mem: %d words available", maxmem);
207 logi(" Dev Name: %s", dev->name );
208 logi(" Max Mem: %d", dev->memsize );
213 if (dev) logd("Device Name: %s", dev->name);
215 /* check that the selected program will fit on this device */
216 if (makesafe_mem(&ram, maxmem)) {
220 logd("After re-organisation");
223 /* now write the updated memory plan to the device */
224 if (!update_mem(pt, dev, maxmem, ram, verify)) {
226 logi("Device Write (and Verify) Complete");
228 logi("Device Write Complete");