2 * lpcload.c - load firmware into ram of lpc2220 via uart0
4 * author: hackbard@hackdaworld.org
12 #include <sys/types.h>
17 #define VERBOSE (1<<0)
18 #define FIRMWARE (1<<1)
20 #define TXRX_TYPE_BAUD 0x01
21 #define TXRX_TYPE_SYNC 0x02
22 #define TXRX_TYPE_CMD 0x03
23 #define TXRX_TYPE_DATA 0x04
25 #define CMD_SUCCESS "0\r\n"
26 #define INVALID_COMMAND "1\r\n"
27 #define SRC_ADDR_ERROR "2\r\n"
28 #define DST_ADDR_ERROR "3\r\n"
29 #define SRC_ADDR_NOT_MAPPED "4\r\n"
30 #define DST_ADDR_NOT_MAPPED "5\r\n"
31 #define COUNT_ERROR "6\r\n"
32 #define COMPARE_ERROR "10\r\n"
34 #define PARAM_ERROR "12\r\n"
35 #define ADDR_ERROR "13\r\n"
36 #define ADDR_NOT_MAPPED "14\r\n"
37 #define CMD_LOCKED "15\r\n"
38 #define INVALID_CODE "16\r\n"
39 #define INVALID_BAUD_RATE "17\r\n"
40 #define INVALID_STOP_BIT "18\r\n"
42 #define CRYSTFREQ "10000"
46 typedef unsigned char u8;
47 typedef unsigned short u16;
48 typedef unsigned int u32;
50 typedef struct s_lpc {
51 int sfd; /* serial fd */
52 char sdev[128]; /* seriel device */
53 int fwfd; /* fimrware fd */
54 char fwfile[128]; /* firmware file */
55 u8 info; /* info/mode */
56 char freq[8]; /* frequency */
57 int partid; /* part id */
58 u8 bcv[2]; /* boot code version */
63 printf("possible argv:\n");
64 printf(" -d <serial device>\n");
65 printf(" -f <firmware>\n");
66 printf(" -c <crystal freq>\n");
71 int open_serial_device(t_lpc *lpc) {
75 //memset(&term,0,sizeof(struct termios));
77 /* open serial device */
79 lpc->sfd=open(lpc->sdev,O_RDWR);
85 /* configure the serial device */
87 tcgetattr(lpc->sfd,&term);
89 // input/output baudrate
91 cfsetispeed(&term,B9600);
92 cfsetospeed(&term,B9600);
94 // control options -> 8n1
96 term.c_cflag&=~PARENB; // no parity
97 term.c_cflag&=~CSTOPB; // only 1 stop bit
98 term.c_cflag&=~CSIZE; // no bit mask for data bits
99 term.c_cflag|=CS8; // 8 data bits
101 // line options -> raw input
103 term.c_lflag&=~(ICANON|ECHO|ECHOE|ISIG);
105 // input options -> disable flow control
107 term.c_iflag&=~(IXON|IXOFF|IXANY);
109 // more control options -> timeout
112 term.c_cc[VTIME]=10; // 1 second timeout
114 tcsetattr(lpc->sfd,TCSANOW,&term);
119 int open_firmware(t_lpc *lpc) {
121 /* open firmware file */
123 lpc->fwfd=open(lpc->fwfile,O_RDONLY);
131 int txrx(t_lpc *lpc,char *buf,int len,u8 type) {
138 if(lpc->info&VERBOSE)
142 ret=write(lpc->sfd,buf+cnt,len);
144 perror("txrx write");
147 if(lpc->info&VERBOSE)
150 ((buf[cnt+i]>0x19)&(buf[cnt+i]<0x7f))?
155 if(lpc->info&VERBOSE)
156 printf(" (%d)\n",cnt);
158 /* cut the echo if not of type auto baud */
160 if(type!=TXRX_TYPE_BAUD) {
162 ret=read(lpc->sfd,buf,cnt);
164 perror("txrx echo cut");
171 /* return here if type is data */
173 if(type==TXRX_TYPE_DATA)
178 if(lpc->info&VERBOSE)
183 ret=read(lpc->sfd,buf+cnt,BUFSIZE-cnt);
188 if(ret+cnt>BUFSIZE) {
189 printf("txrx read: too small buf size (%d)!\n",BUFSIZE);
192 if(lpc->info&VERBOSE)
195 ((buf[cnt+i]>0x19)&(buf[cnt+i]<0x7f))?
199 if(lpc->info&VERBOSE)
200 printf(" (%d)\n",cnt);
203 /* check/strip return code if type is data */
205 if(type==TXRX_TYPE_CMD) {
206 ret=strlen(CMD_SUCCESS);
207 if(!strncmp(buf,CMD_SUCCESS,ret)) {
213 printf("txrx bad return code!\n");
221 int bl_init(t_lpc *lpc) {
226 /* auto baud sequence */
228 txrx(lpc,buf,1,TXRX_TYPE_BAUD);
229 if(strncmp(buf,"Synchronized\r\n",14)) {
230 printf("auto baud detection failed\n");
234 /* tell bl that we are synchronized (it's allready in buf) */
235 txrx(lpc,buf,14,TXRX_TYPE_SYNC);
236 if(strncmp(buf,"OK\r\n",4)) {
237 printf("sync failed\n");
241 /* tell bl the crystal frequency */
242 len=strlen(lpc->freq)+2;
243 strncpy(buf,lpc->freq,BUFSIZE);
246 txrx(lpc,buf,len,TXRX_TYPE_SYNC);
247 if(strncmp(buf,"OK\r\n",4)) {
248 printf("freq set failed\n");
255 int read_part_id(t_lpc *lpc) {
259 memcpy(buf,"J\r\n",3);
260 txrx(lpc,buf,3,TXRX_TYPE_CMD);
261 lpc->partid=atoi(buf);
266 int read_bcv(t_lpc *lpc) {
271 memcpy(buf,"K\r\n",3);
272 txrx(lpc,buf,3,TXRX_TYPE_CMD);
273 ptr=strtok(buf,"\r\n");
274 lpc->bcv[0]=strtol(ptr,NULL,16);
275 ptr=strtok(NULL,"\r\n");
276 lpc->bcv[1]=strtol(ptr,NULL,16);
281 int uuencode(u8 *in,char *out) {
283 out[0]=0x20+((in[0]>>2)&0x3f);
284 out[1]=0x20+(((in[0]<<4)|(in[1]>>4))&0x3f);
285 out[2]=0x20+(((in[1]<<2)|(in[2]>>6))&0x3f);
286 out[3]=0x20+(in[2]&0x3f);
291 int write_to_ram(t_lpc *lpc,u8 *buf,u32 addr,int len) {
295 char txrxbuf[BUFSIZE];
302 printf("ram write: not a multiple of 4\n");
306 /* make it a multiple of 3 (reason: uuencode) */
309 printf("ram write: too much data\n");
312 for(i=len;i<nlen;i++) buf[i]=0;
314 /* prepare write command */
315 snprintf(txrxbuf,BUFSIZE,"W %d %d\r\n",addr,len);
316 slen=strlen(txrxbuf);
318 /* send command and check return code */
319 txrx(lpc,txrxbuf,slen,TXRX_TYPE_CMD);
320 if(strncmp(txrxbuf,"OK\r\n",4)) {
321 printf("ram write: write command failed\n");
332 /* uuencode / prepare data bytes */
333 uuencode(buf+bcnt,txrxbuf);
338 checksum+=(buf[0]+buf[1]+buf[2]);
340 /* send a data line */
341 txrx(lpc,txrxbuf,6,TXRX_TYPE_DATA);
343 /* increase counters */
349 if((!(lcount%20))|(bcnt==nlen)) {
351 snprintf(txrxbuf,BUFSIZE,"%d\r\n",checksum);
352 slen=strlen(txrxbuf);
353 txrx(lpc,txrxbuf,slen,TXRX_TYPE_CMD);
354 if(!strncmp(txrxbuf,"RESEND\r\n",8)) {
355 printf("ram write: resending ...\n");
358 if(strncmp(txrxbuf,"OK\r\n",4)) {
359 printf("ram write: bad response\n");
362 /* reset checksum & counter */
372 int firmware_to_ram(t_lpc *lpc) {
376 u32 addr,len,type,val;
383 ret=read(lpc->fwfd,buf,1);
393 printf("fw to ram: no ihex format\n");
397 ret=read(lpc->fwfd,buf,2);
398 sscanf(buf,"%02x",&len);
400 printf("fw to ram: len not a multiple of 4\n");
404 ret=read(lpc->fwfd,buf,4);
405 sscanf(buf,"%04x",&addr);
407 ret=read(lpc->fwfd,buf,2);
408 sscanf(buf,"%02x",&type);
409 /* successfull return if type is end of file */
413 ret=read(lpc->fwfd,buf,2*len);
415 printf("fw to ram: data missing\n");
421 sscanf(buf+2*i,"%02x",&val);
425 ret=read(lpc->fwfd,buf,2);
426 sscanf(buf,"%02x",&val);
427 if(val+cksum!=0x100) {
428 printf("fw to ram: wrong checksum\n");
431 /* act according to type */
437 write_to_ram(lpc,data,addr,len);
440 printf("fw to ram: unknown type %02x\n",type);
448 int main(int argc,char **argv) {
457 memset(&lpc,0,sizeof(t_lpc));
458 strncpy(lpc.freq,CRYSTFREQ,7);
462 for(i=1;i<argc;i++) {
464 if(argv[i][0]!='-') {
471 strncpy(lpc.sdev,argv[++i],127);
474 strncpy(lpc.fwfile,argv[++i],127);
481 strncpy(lpc.freq,argv[++i],7);
490 /* open serial port */
491 if(open_serial_device(&lpc)<0)
494 /* boot loader init */
495 printf("boot loader init ...\n");
500 printf("part id: %d\n",lpc.partid);
502 /* read boot code version */
504 printf("boot code version: %02x %02x\n",lpc.bcv[0],lpc.bcv[1]);
506 // to be continued ... (parsing fw file and poking it to ram)
507 if(open_firmware(&lpc)<0)
509 firmware_to_ram(&lpc);