Initial transfer from sourceforge

lpctool/testing/bootcom.c

@@ -0,0 +1,308 @@
+#include "infohelper.h"
+#include "lpctool_serial.h"
+#include "bootcom.h"
+#include "tool_data.h"
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <unistd.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <fcntl.h>
+#include <termios.h>
+
+unsigned int uuencode(unsigned char *ibuf, unsigned char *obuf, int len) 
+{
+	unsigned int slen, r,s;
+	unsigned char q;
+	slen = len;
+
+	r = 0;
+	s = 0;
+
+	while(slen >= 45)
+	{
+
+		obuf[r++]=77;
+		for(q=0;q<45;q+=3)
+		{
+
+			obuf[r++]=0x20+(( ibuf[s]>>2)&0x3f);
+			obuf[r++]=0x20+(((ibuf[s]<<4) | (ibuf[s+1]>>4))&0x3f);
+			s++;
+			obuf[r++]=0x20+(((ibuf[s]<<2)|(ibuf[s+1]>>6))&0x3f);
+			s++;
+			obuf[r++]=0x20+(  ibuf[s++]&0x3f);
+		}
+		obuf[r++] = '\r';
+		obuf[r++] = '\n';
+		slen -= 45;
+	}
+
+	if(slen)
+	{
+		obuf[r++]=0x20+slen;
+		for(q=0;q<slen;q+=3)
+		{
+				obuf[r++]=0x20+(( ibuf[s]>>2)&0x3f);
+				obuf[r++]=0x20+(((ibuf[s]<<4) | (ibuf[s+1]>>4))&0x3f);
+				s++;
+				obuf[r++]=0x20+(((ibuf[s]<<2)|(ibuf[s+1]>>6))&0x3f);
+				s++;
+				obuf[r++]=0x20+(  ibuf[s++]&0x3f);
+		}
+		obuf[r++] = '\r';
+		obuf[r++] = '\n';
+	}
+
+	return r;
+}
+
+void printBuf(unsigned char len, unsigned char *buf)
+{
+	unsigned char cnt;
+	cnt = 0;
+	while(len--)
+		printf("%c",buf[cnt++]);
+}
+
+int getOK(unsigned char oktype)
+{
+	char buf[4];
+	unsigned char q;
+
+	switch(oktype)
+	{
+		case OK_LIT:
+			q = getBuf(4, buf);
+			if(strncmp(buf, "OK\r\n", 4))
+			{
+				return printError("wrong response, expected OK");
+			}
+			return 1;
+			break;
+
+		case OK_0:
+			q = getBuf(3, buf);
+			if(strncmp(buf, "0", 1))
+			{
+				return printError("wrong response, expected 0");
+			}
+			return 1;
+			break;
+	}
+}
+
+int openBootLoader(unsigned int cfreq)
+{
+	char buf[20];
+	unsigned char q;	
+
+	printInfoS(2,"initiating auto-baud",0);
+	tcflush(serialDev, TCIOFLUSH);
+	sendBuf(sprintf(buf, "?\r\n"), buf);
+
+	printInfoS(2,"awaiting autobaud response",0);
+
+	q = getBuf(14, buf);
+
+	if(strncmp(buf, "Synchronized\r\n", 14))
+	{
+		return printError("autobaud detection failed");
+	}
+
+	printInfoS(2,"got response, answering",0);
+
+	q = sendBufE(q, buf);
+
+	if(!getOK(OK_LIT))
+	{
+		return printError("cant synchronize bootloader");
+	}
+
+	printInfoS(2,"setting frequency",0);
+
+	sendBufE(sprintf(buf, "%i\r\n", cfreq), buf);
+
+	if(!getOK(OK_LIT))
+	{
+		return printError("cant set frequency");
+	}
+
+	printInfoS(2,"switching baudrate",0);
+	 
+	sendBufE(sprintf(buf, "B 38400 1\r\n"), buf);
+
+	if(!getOK(OK_0))
+	{
+		return printError("cant set baudrate");
+	}
+
+	reconfSerial(38400, 1, 10);
+
+	printInfoS(2,"disabling echo",0);
+
+	sendBufE(sprintf(buf, "A 0\r\n"), buf);
+
+	if(!getOK(OK_0))
+	{
+		return printError("cant disable echo");
+	}
+	return 1;
+}
+
+int unlockBootLoader(void)
+{
+	char buf[20];
+
+	sendBuf(sprintf(buf, "U 23130\r\n"), buf);
+
+	if(!getOK(OK_0))
+	{
+		return printError("cant unlock bootloader");
+	}
+	return 1;
+
+}
+
+int goBootLoader(unsigned long addr)
+{
+	char buf[20];
+
+	sendBuf(sprintf(buf, "G %lu A\r\n", addr), buf);
+
+	if(!getOK(OK_0))
+	{
+		return printError("cant issue go command");;
+	}
+	return 1;
+}
+
+#define BSIZE 400
+
+int uploadData(unsigned long addr, unsigned long len, unsigned char *ibuf)
+{
+	char buf[128];
+	unsigned char uubuf[BSIZE*3];
+	unsigned int blen, csum;
+	unsigned long slen, saddr, soff;
+	slen = len;
+	saddr = addr;
+	soff = 0;
+
+	if(addr & 0x3)
+	{
+		return printError("RAM address not on dword boundary");
+	}
+
+	while(slen >= BSIZE)
+	{
+		sendBuf(sprintf(buf, "W %lu %i\r\n", saddr+soff, BSIZE), buf);
+		if(!getOK(OK_0))
+		{
+			return printError("cant write data");
+		}
+
+		csum = 0;
+
+		for(blen = 0; blen < BSIZE; blen++)
+		{
+			csum += ibuf[soff+blen];
+		}
+
+		blen = uuencode(ibuf+soff, uubuf, BSIZE);
+		sendBuf(blen, (char*)uubuf);
+		sendBuf(sprintf(buf, "%u\r\n", csum), buf);
+		if(!getOK(OK_LIT))
+		{
+			return printError("error in checksum");
+		}
+		slen -= BSIZE;
+		soff += BSIZE;
+	}
+
+	if(slen)
+	{
+		sendBuf(sprintf(buf, "W %lu %lu\r\n", saddr+soff, slen), buf);
+		if(!getOK(OK_0))
+		{
+			
+			return printError("cant write remaining data");
+		}
+	
+		csum = 0;
+	
+		for(blen = 0; blen < slen; blen++)
+		{
+			csum += ibuf[soff+blen];
+		}
+	
+		blen = uuencode(ibuf+soff, uubuf, slen);
+		sendBuf(blen, (char*)uubuf);
+		sendBuf(sprintf(buf, "%i\r\n", csum), buf);
+
+		if(!getOK(OK_LIT))
+		{
+			return printError("error in checksum for remaining data");
+		}
+
+	}
+	return 1;
+}
+
+int uploadRAM(int fd, int loc)
+{
+	unsigned char buf[70000];
+
+	unsigned long fx, total, size;
+	total = 0;
+
+	if(fd)
+	{
+		printInfoS(2,"reading image into buffer", 0);
+		fx = read(fd,buf,70000);
+	}
+	else
+	{
+		for(fx=0; fx<tool_len; fx++)
+		{
+			buf[fx] = tool_data[fx];
+		}
+		fx = tool_len;
+	}
+
+	size = fx;
+
+	printInfoS(0,"starting ram upload", 0);
+
+	printProgress(0,"RAM",total,fx);
+
+	while(fx)
+	{
+		if(fx >= 256)
+		{
+			if(!uploadData(loc+total, 256, buf+total))
+			{
+				return printError("Error in upload");
+			}
+			total += 256;
+			fx -= 256;
+		}
+		else
+		{
+			if(!uploadData(loc+total, fx, buf+total))
+			{
+				return printError("Error in upload");
+			}
+			total += fx;
+			fx -= fx;
+		}
+
+		printProgress(0,"RAM",total,size);
+	}
+
+	printInfoH(0,"ram upload complete, total bytes:", total);
+
+	return 1;
+}