mirror of
git://projects.qi-hardware.com/ben-blinkenlights.git
synced 2024-07-03 00:29:49 +03:00
354 lines
6.4 KiB
C
354 lines
6.4 KiB
C
/*
|
|
* lpc111x-isp/lpc111x.c - LPC111x/LPC11Cxx ISP programmer
|
|
*
|
|
* Written 2012 by Werner Almesberger
|
|
* Copyright 2012 Werner Almesberger
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*/
|
|
|
|
|
|
#define _GNU_SOURCE /* for vasprintf */
|
|
#include <stdarg.h>
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <unistd.h>
|
|
#include <string.h>
|
|
#include <alloca.h>
|
|
|
|
#include <ubb/ubb.h>
|
|
#include <ubb/swuart.h>
|
|
|
|
|
|
#define TGT_nRESET UBB_CMD
|
|
#define TGT_nISP UBB_DAT1
|
|
#define TGT_TX UBB_DAT3
|
|
#define TGT_RX UBB_DAT2
|
|
|
|
#define HOST_RX TGT_TX
|
|
#define HOST_TX TGT_RX
|
|
|
|
#define AUTOBAUD_TRIES 10
|
|
#define SYNC "Synchronized"
|
|
|
|
#define TRACE_ECHO (verbose > 3)
|
|
#define TRACE_PROGRESS (verbose > 2)
|
|
#define TRACE_RETRY (verbose > 1)
|
|
#define TRACE_FATAL (verbose > 0)
|
|
|
|
static int verbose = 0;
|
|
static int quiet = 0;
|
|
|
|
|
|
/* ----- Debugging and tracing --------------------------------------------- */
|
|
|
|
|
|
static void trace(const char *label, const uint8_t *s, int len)
|
|
{
|
|
const uint8_t *end = s+len;
|
|
|
|
if (label)
|
|
printf("%s ", label);
|
|
for (end = s+len; s != end; s++) {
|
|
if (*s >= ' ' && *s <= '~')
|
|
printf("%c", *s);
|
|
else if (*s == 10)
|
|
printf(s+1 == end ? "\n" : "\\n");
|
|
else if (*s == 13)
|
|
;
|
|
else
|
|
printf("\\%02o", *s);
|
|
}
|
|
if (len && end[-1] != '\n')
|
|
printf("...\n");
|
|
}
|
|
|
|
|
|
static void trace_out(const void *s, int len)
|
|
{
|
|
trace(">>>", s, len);
|
|
}
|
|
|
|
|
|
static void trace_in(const void *s, int len)
|
|
{
|
|
trace("<<<", s, len);
|
|
}
|
|
|
|
|
|
/* ----- Dialog functions -------------------------------------------------- */
|
|
|
|
|
|
static int dialog_fixed(void *buf, int buf_len, int idle, const char *msg)
|
|
{
|
|
int msg_len = strlen(msg);
|
|
char *tx_buf = alloca(msg_len+3);
|
|
uint8_t *rx_buf = alloca(msg_len+2+buf_len);
|
|
int got;
|
|
|
|
memcpy(tx_buf, msg, msg_len);
|
|
memcpy(tx_buf+msg_len, "\r\n", 2);
|
|
|
|
if (TRACE_PROGRESS)
|
|
trace_out(tx_buf, msg_len+2);
|
|
got = swuart_trx(tx_buf, msg_len+2, rx_buf, msg_len+2+buf_len,
|
|
idle, idle);
|
|
|
|
if (got < msg_len+2) {
|
|
if (TRACE_FATAL)
|
|
trace_in(rx_buf, got);
|
|
fprintf(stderr, "response too short for echo\n");
|
|
exit(1);
|
|
}
|
|
if (memcmp(rx_buf, msg, msg_len) ||
|
|
rx_buf[msg_len] != '\r' || rx_buf[msg_len+1] != '\n') {
|
|
if (TRACE_FATAL)
|
|
trace_in(rx_buf, got);
|
|
fprintf(stderr, "echo mismatch\n");
|
|
exit(1);
|
|
}
|
|
|
|
if (TRACE_ECHO)
|
|
trace_in(rx_buf, msg_len+2);
|
|
|
|
got -= msg_len+2;
|
|
memcpy(buf, rx_buf+msg_len+2, got);
|
|
|
|
return got;
|
|
}
|
|
|
|
|
|
static int vdialog(void *buf, int buf_len, int idle,
|
|
const char *cmd, va_list ap)
|
|
{
|
|
char *msg;
|
|
|
|
vasprintf(&msg, cmd, ap);
|
|
return dialog_fixed(buf, buf_len, idle, msg);
|
|
}
|
|
|
|
|
|
static int dialog(void *buf, int buf_len, int idle, const char *cmd, ...)
|
|
{
|
|
va_list ap;
|
|
int res;
|
|
|
|
va_start(ap, cmd);
|
|
res = vdialog(buf, buf_len, idle, cmd, ap);
|
|
va_end(ap);
|
|
return res;
|
|
}
|
|
|
|
|
|
static unsigned dialog_rc(char *buf, int buf_len, int idle,
|
|
const char *cmd, ...)
|
|
{
|
|
char *rx_buf = alloca(buf_len+4);
|
|
va_list ap;
|
|
const char *p, *end;
|
|
int got;
|
|
unsigned rc;
|
|
|
|
va_start(ap, cmd);
|
|
got = vdialog(rx_buf, buf_len+4, idle, cmd, ap);
|
|
va_end(ap);
|
|
|
|
p = memchr(rx_buf, '\r', buf_len+4);
|
|
if (!p || p-rx_buf == got || p[1] != '\n' ||
|
|
sscanf(rx_buf, "%u", &rc) != 1) {
|
|
if (!TRACE_PROGRESS)
|
|
trace_in(rx_buf, got);
|
|
fprintf(stderr, "invalid status\n");
|
|
exit(1);
|
|
}
|
|
|
|
/* @@@ check that the tail really fits */
|
|
|
|
for (end = rx_buf+got; p != end; p++) {
|
|
if (*p == '\r')
|
|
continue;
|
|
if (*p == '\n' && p+1 == end)
|
|
break;
|
|
*buf++ = *p;
|
|
}
|
|
|
|
*buf = 0;
|
|
|
|
return rc;
|
|
}
|
|
|
|
|
|
static int autobaud(void)
|
|
{
|
|
uint8_t reply[100];
|
|
int i, got;
|
|
|
|
for (i = 0; i != AUTOBAUD_TRIES; i++) {
|
|
CLR(TGT_nRESET);
|
|
usleep(10); /* DS Table 9 pg 29 says min 50 ns */
|
|
SET(TGT_nRESET);
|
|
|
|
usleep(5*1000); /* UM 26.3.1 pg 408 says max 3 ms */
|
|
|
|
got = swuart_trx("?", 1, reply, sizeof(reply), 1000, 100);
|
|
|
|
if (got != strlen(SYNC)+2 || memcmp(reply, SYNC "\r\n", got)) {
|
|
if (TRACE_RETRY)
|
|
trace_in(reply, got);
|
|
continue;
|
|
}
|
|
if (TRACE_PROGRESS)
|
|
trace_in(reply, got);
|
|
|
|
got = dialog(reply, sizeof(reply), 100, SYNC);
|
|
|
|
if (got == 4 && !memcmp(reply, "OK\r\n", 4)) {
|
|
if (TRACE_PROGRESS)
|
|
trace_in(reply, got);
|
|
return 1;
|
|
}
|
|
if (TRACE_RETRY)
|
|
trace_in(reply, got);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
|
|
/* ----- Devices database -------------------------------------------------- */
|
|
|
|
|
|
static const struct device {
|
|
const char *name;
|
|
unsigned id;
|
|
int flash_kb;
|
|
} devices[] = {
|
|
{ "LPC1112FHxxx/202", 0x2524902b, 16 },
|
|
{ NULL, }
|
|
}, *device = NULL;
|
|
|
|
|
|
static void identify(void)
|
|
{
|
|
char reply[1000];
|
|
unsigned rc, id;
|
|
|
|
rc = dialog_rc(reply, sizeof(reply), 100, "J");
|
|
if (rc) {
|
|
fprintf(stderr, "J: rc %u\n", rc);
|
|
exit(1);
|
|
}
|
|
if (sscanf(reply, "%u", &id) != 1) {
|
|
fprintf(stderr, "J: cannot parse ID \"%s\"\n", reply);
|
|
exit(1);
|
|
}
|
|
|
|
for (device = devices; device->name; device++)
|
|
if (device->id == id) {
|
|
if (!quiet)
|
|
fprintf(stderr, "%s (0x%04x %04x) %d kB\n",
|
|
device->name, id >> 16, id & 0xffff,
|
|
device->flash_kb);
|
|
return;
|
|
}
|
|
|
|
fprintf(stderr, "unknown device 0x%04x %04x\n", id >> 16, id & 0xffff);
|
|
exit(1);
|
|
}
|
|
|
|
|
|
/* ----- ISP session ------------------------------------------------------- */
|
|
|
|
|
|
static void at_exit(void)
|
|
{
|
|
ubb_close(0);
|
|
}
|
|
|
|
|
|
static void start_isp(void)
|
|
{
|
|
uint8_t reply[1000];
|
|
int got;
|
|
|
|
if (ubb_open(0) < 0) {
|
|
perror("ubb_open");
|
|
exit(1);
|
|
}
|
|
atexit(at_exit);
|
|
|
|
ubb_power(1);
|
|
|
|
usleep(100*1000);
|
|
|
|
SET(TGT_nRESET);
|
|
OUT(TGT_nRESET);
|
|
|
|
CLR(TGT_nISP);
|
|
OUT(TGT_nISP);
|
|
|
|
swuart_open(HOST_TX, HOST_RX, 115200);
|
|
|
|
if (!autobaud()) {
|
|
fprintf(stderr, "target is not responding\n");
|
|
exit(1);
|
|
}
|
|
|
|
got = dialog(reply, sizeof(reply), 100, "12000");
|
|
if (got != 4 || memcmp(reply, "OK\r\n", 4)) {
|
|
if (TRACE_FATAL)
|
|
trace_in(reply, got);
|
|
fprintf(stderr, "cannot set clock rate\n");
|
|
exit(1);
|
|
}
|
|
if (TRACE_PROGRESS)
|
|
trace_in(reply, got);
|
|
}
|
|
|
|
|
|
/* ----- Command-line processing ------------------------------------------- */
|
|
|
|
|
|
static void usage(const char *name)
|
|
{
|
|
fprintf(stderr,
|
|
"usage: %s [-q] [-v ...]\n\n"
|
|
" -q suppress basic progress messages\n"
|
|
" -v increase verbosity level (nothing; errors; retry; progress; echo)\n"
|
|
, name);
|
|
exit(1);
|
|
}
|
|
|
|
|
|
int main(int argc, char **argv)
|
|
{
|
|
int c;
|
|
|
|
while ((c = getopt(argc, argv, "qv")) != EOF)
|
|
switch (c) {
|
|
case 'q':
|
|
quiet = 1;
|
|
break;
|
|
case 'v':
|
|
verbose++;
|
|
break;
|
|
default:
|
|
usage(*argv);
|
|
}
|
|
|
|
switch (argc-optind) {
|
|
case 0:
|
|
break;
|
|
default:
|
|
usage(*argv);
|
|
}
|
|
|
|
start_isp();
|
|
|
|
identify();
|
|
|
|
return 0;
|
|
}
|