From 06f0d74175f574957b36feb8de62599b09cdbede Mon Sep 17 00:00:00 2001 From: "Steinar H. Gunderson" Date: Fri, 9 Jul 2010 00:42:22 +0200 Subject: [PATCH] Updates for FR60 support. (Sorry, one big monolithic hunk.) --- Makefile | 8 +- antdefs.h | 3 + antlib.c | 37 +- fr60.c | 741 +++++++++++++++++++++++++++++++ gant.c | 1203 --------------------------------------------------- gant.c.orig | 1182 -------------------------------------------------- 6 files changed, 783 insertions(+), 2391 deletions(-) create mode 100644 fr60.c delete mode 100644 gant.c delete mode 100644 gant.c.orig diff --git a/Makefile b/Makefile index 439bd9f..71bbc0a 100644 --- a/Makefile +++ b/Makefile @@ -1,13 +1,13 @@ CFLAGS=-g -Werror LDFLAGS=-lpthread -lm -all: gant +all: fr60 -gant: gant.o antlib.o +fr60: fr60.o antlib.o -gant.o: gant.c antdefs.h +fr60.o: fr60.c antdefs.h antlib.o: antlib.c antdefs.h clean: - rm *.o gant + rm -f *.o fr60 diff --git a/antdefs.h b/antdefs.h index b3d3cf0..92bde76 100644 --- a/antdefs.h +++ b/antdefs.h @@ -40,5 +40,8 @@ typedef uchar (*CHANNEL_EVENT_FUNC)(uchar chan, uchar event); #define MESG_UNASSIGN_CHANNEL_ID 0x41 #define RESPONSE_NO_ERROR 0x00 #define EVENT_RX_FAIL 0x02 +#define EVENT_TRANSFER_RX_FAILED 0x04 +#define EVENT_TRANSFER_TX_FAILED 0x06 +#define TRANSFER_SEQUENCE_NUMBER_ERROR 0x20 /* vim: se sw=8 ts=8: */ diff --git a/antlib.c b/antlib.c index 7a1668e..66e4bd8 100644 --- a/antlib.c +++ b/antlib.c @@ -79,6 +79,39 @@ msg_send(uchar mesg, uchar *inbuf, uchar len) return 1; } +uchar +msg_send_pad(uchar mesg, uchar *inbuf, uchar len) +{ + uchar buf[MAXMSG]; + ssize_t nw; + int i; + uchar chk = MESG_TX_SYNC; + + buf[0] = MESG_TX_SYNC; + buf[1] = len; chk ^= len; + buf[2] = mesg; chk ^= mesg; + for (i = 0; i < len; i++) { + buf[3+i] = inbuf[i]; + chk ^= inbuf[i]; + } + buf[3+i] = chk; + buf[4+i] = 0; + buf[5+i] = 0; + usleep(10*1000); + if (6+i != (nw=write(fd, buf, 6+i))) { + if (dbg) { + perror("failed write"); + } + } else if (dbg == 2) { + // Wali: additional raw data output + printf(">>>\n 00000000:"); + for (i = 0; i < (len + 4); i++) { + printf(" %02x", buf[i]); + } + putchar('\n'); + } + return 1; +} // two argument send uchar msg_send2(uchar mesg, uchar data1, uchar data2) @@ -575,7 +608,7 @@ ANT_SendBurstTransferA(uchar chan, uchar *data, ushort numpkts) for (i = 0; i < 8; i++) buf[1+i] = hexval(data[j*16+i*2])*16+hexval(data[j*16+i*2+1]); usleep(20*1000); - msg_send(MESG_BURST_DATA_ID, buf, 9); + msg_send_pad(MESG_BURST_DATA_ID, buf, 9); seq++; if (seq > 3) seq = 1; } return numpkts; @@ -593,7 +626,7 @@ ANT_SendBurstTransfer(uchar chan, uchar *data, ushort numpkts) buf[0] = chan|(seq<<5)|(j==numpkts-1 ? 0x80 : 0); memcpy(buf+1, data+j*8, 8); usleep(20*1000); - msg_send(MESG_BURST_DATA_ID, buf, 9); + msg_send_pad(MESG_BURST_DATA_ID, buf, 9); seq++; if (seq > 3) seq = 1; } return numpkts; diff --git a/fr60.c b/fr60.c new file mode 100644 index 0000000..7d569db --- /dev/null +++ b/fr60.c @@ -0,0 +1,741 @@ +// copyright 2008-2009 paul@ant.sbrk.co.uk. released under GPLv3 +// copyright 2009-2009 Wali +// vers 0.6t +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "antdefs.h" + +#define ANTFS_DIR_MAX_SIZE 256 // fairly arbitrary + +static int sentauth; +static int gotwatchid; +static int nopairing; +static int nowriteauth; +static int reset; +static int dbg = 0; +static int seenphase0 = 0; +static int lastphase; +static int sentack2; +static int newfreq = 0; +static int period = 0x1000; // garmin specific broadcast period +static int donebind = 0; +static int sentgetv; +static char *fname = "garmin"; + +static char ANTSPT_KEY[] = "A8A423B9F55E63C1"; // ANT+Sport key + +static uchar ebuf[MESG_DATA_SIZE]; // response event data gets stored here +static uchar cbuf[MESG_DATA_SIZE]; // channel event data gets stored here + +static int passive; +static int verbose; + +static int downloadfinished = 0; +static int downloadstarted = 0; +static int downloadingfilenum = -1; +static int sentid = 0; + +static uint mydev = 0; +static uint peerdev; +static uint myid; +static uint devid; +static uint myauth1; +static uint myauth2; +static uint myauth3; +static uint myauth4; +static char authdata[32]; +static uint pairing; +static uint waitauth; +static int nphase0; + +static char *authfile; +static char *progname; + +static uchar *blast; + +static int blsize = 0; + +uint +randno(void) +{ + uint r; + + int fd = open("/dev/urandom", O_RDONLY); + if (fd > 0) { + read(fd, &r, sizeof r); + close(fd); + } + return r; +} + +#pragma pack(1) +struct ack_msg { + uchar code; + uchar atype; + uchar c1; + uchar c2; + uint id; +}; +struct auth_msg { + uchar code; + uchar atype; + uchar phase; + uchar u1; + uint id; + uint auth1; + uint auth2; + uint auth3; + uint auth4; + uint fill1; + uint fill2; +}; + +struct pair_msg { + uchar code; + uchar atype; + uchar phase; + uchar u1; + uint id; + char devname[16]; +}; + +struct antfs_dir_header { + uchar version; // ? + uchar header_length; // ? + uchar unknown1[6]; // probably unused (seems to always be zero) + uint system_time; // seconds since last reset + uint real_time; // UTC, seconds since 1989-12-31 00:00 +}; + +struct antfs_dir_entry { + ushort fileno; + uchar filetype; // 128 = FIT file + uchar subtype; + ushort unknown1; + uchar unknown2; + uchar flags; + uint size; + uint last_modified; +}; + +static struct antfs_dir_entry antfsdir[ANTFS_DIR_MAX_SIZE]; +static int antfsdir_used = 0; + +#pragma pack() +#define ACKSIZE 8 // above structure must be this size +#define AUTHSIZE 32 // ditto +#define PAIRSIZE 16 +#define ANTFSHEADERSIZE 16 +#define ANTFSDIRSIZE 16 + +void +usage(void) +{ + fprintf(stderr, "Usage: %s -a authfile\n" + "[ -d devno ]\n" + "[ -i id ]\n" + "[ -m mydev ]\n" + "[ -p ]\n", + progname + ); + exit(1); +} + +void +start_download(uchar chan, int fileno) +{ + char getfilepkt[100]; + sprintf(getfilepkt, "4409%02x00000000000001000000000000", fileno); + ANT_SendBurstTransferA(chan, getfilepkt, strlen(getfilepkt)/16); +} + +size_t +format_time(char* s, size_t max, time_t tm) +{ + time_t unix_tm = tm + 631065600; + struct tm local_tm; + localtime_r(&unix_tm, &local_tm); + return strftime(s, max, "%c", &local_tm); +} + +void +decode_antfs_dir(const uchar* blast, uint blsize) +{ + struct antfs_dir_header hdr; + char textual_time[256]; + if (24 + ANTFSHEADERSIZE > blsize) { + fprintf(stderr, "truncated ant-fs directory header (blsize=%d)\n", blsize); + exit(1); + } + assert(sizeof(struct antfs_dir_header) == ANTFSHEADERSIZE); + + memcpy(&hdr, blast + 24, ANTFSHEADERSIZE); + printf("system time: %d\n", hdr.system_time); + format_time(textual_time, 256, hdr.real_time); + printf("real time: %d (%s)\n", hdr.real_time, textual_time); + + antfsdir_used = 0; + for ( ;; ) { + uint pos = 40 + antfsdir_used * sizeof(struct antfs_dir_entry); + assert(sizeof(struct antfs_dir_entry) == ANTFSDIRSIZE); + if (pos + ANTFSDIRSIZE > blsize) { + if (blast[pos] == 0) { + break; + } + fprintf(stderr, "premature end of ant-fs directory after %d entries (blsize=%d)\n", antfsdir_used, blsize); + exit(1); + } + memcpy(antfsdir + antfsdir_used, blast + pos, ANTFSDIRSIZE); + if (verbose) { + format_time(textual_time, 256, antfsdir[antfsdir_used].last_modified); + + printf("directory entry %d: pos=%d, type=(%d,%d) unknown1=%d unknown2=%d flags=0x%02x size=%d last_modified=%d (%s)\n", + antfsdir_used, + antfsdir[antfsdir_used].fileno, + antfsdir[antfsdir_used].filetype, + antfsdir[antfsdir_used].subtype, + antfsdir[antfsdir_used].unknown1, + antfsdir[antfsdir_used].unknown2, + antfsdir[antfsdir_used].flags, + antfsdir[antfsdir_used].size, + antfsdir[antfsdir_used].last_modified, + textual_time); + } + if (antfsdir[antfsdir_used].fileno == 0) { + break; + } + ++antfsdir_used; + } + if (dbg) printf("%d entries in directory\n", antfsdir_used); +} + +void +save_antfs_file(const uchar* blast, uint blsize) +{ + uint size; + int storefd; + char filename[256]; + int nw; + + if (dbg) printf("received ant-fs file %d\n", antfsdir[downloadingfilenum].fileno); + if (blsize < 24) { + if (dbg) printf("didn't receive full ant-fs header\n"); + exit(1); + } + size = blast[12] + blast[13]*256 + blast[14]*256*256 + blast[15]*256*256*256; + if (size > blsize - 24 || size > blsize - 24 + 16) { + if (dbg) printf("unexpected ant-fs packet: header says %d bytes, but received %d\n", size, blsize - 24); + exit(1); + } + sprintf(filename, "antfs-dump.%d", antfsdir[downloadingfilenum].fileno); + storefd = open(filename, O_WRONLY | O_CREAT | O_TRUNC, 0644); + if (storefd < 0) { + perror(filename); + exit(1); + } + nw = write(storefd, blast + 24, size); + if (nw < 0 || (uint)nw != size) { + fprintf(stderr, "store write failed fd %d %d\n", storefd, nw); + perror("write"); + exit(1); + } + close(storefd); + if (verbose) printf("%s (%d bytes)\n", filename, size); +} + +uchar +chevent(uchar chan, uchar event) +{ + uchar last; + struct ack_msg ack; + struct auth_msg auth; + struct pair_msg pair; + uint id; + int i; + uint cid; + if (dbg) printf("chevent %02x %02x\n", chan, event); + + if (event == EVENT_RX_BROADCAST) { + } + cid = cbuf[4]+cbuf[5]*256+cbuf[6]*256*256+cbuf[7]*256*256*256; + memcpy((void *)&id, cbuf+4, 4); + + if (dbg) + fprintf(stderr, "cid %08x myid %08x\n", cid, myid); + if (dbg && event != EVENT_RX_BURST_PACKET) { + fprintf(stderr, "chan %d event %02x channel open: ", chan, event); + for (i = 0; i < 8; i++) + fprintf(stderr, "%02x", cbuf[i]); + fprintf(stderr, "\n"); + } + + switch (event) { + case EVENT_RX_BROADCAST: { + uchar status = cbuf[1] & 0xd7; + uchar newdata = cbuf[1] & 0x20; + uchar phase = cbuf[2]; + if (memcmp(cbuf, "FR60\0\0\0\0", 8) == 0) { + if (dbg) printf("device identifies as an FR60\n"); + break; + } + lastphase = phase; // store the last phase we see the watch broadcast + if (dbg) printf("lastphase %d\n", lastphase); + if (!pairing && !nopairing) + pairing = cbuf[1] & 8; + + if (dbg) + printf("watch status %02x phase %d id %08x\n", status, phase, id); + + if (!sentid) { + sentid = 1; + ANT_RequestMessage(chan, MESG_CHANNEL_ID_ID); /* request sender id */ + } + + // if we don't see a phase 0 message first, reset the watch + if (reset || (phase != 0 && !seenphase0)) { + fprintf(stderr, "resetting\n"); + ack.code = 0x44; ack.atype = 3; ack.c1 = 0x00; ack.c2 = 0x00; ack.id = 0; + ANT_SendAcknowledgedData(chan, (void *)&ack); // tell garmin we're finished + sleep(1); + exit(1); + } + switch (phase) { + case 0: + seenphase0 = 1; + nphase0++; + if (nphase0 % 10 == 0) + donebind = 0; + if (newfreq) { + // switch to new frequency + ANT_SetChannelPeriod(chan, period); + ANT_SetChannelSearchTimeout(chan, 3); + ANT_SetChannelRFFreq(chan, newfreq); + newfreq = 0; + } + if (0 && !newdata) { + if (dbg) printf("device has no new data, not downloading\n"); + break; + } + // phase 0 seen after reset at end of download + if (downloadfinished) { + fprintf(stderr, "finished\n"); + exit(0); + } + // generate a random id if pairing and user didn't specify one + if (pairing && !myid) { + myid = randno(); + fprintf(stderr, "pairing, using id %08x\n", myid); + } + // need id codes from auth file if not pairing + // TODO: handle multiple watches + // BUG: myauth1 should be allowed to be 0 + if (!pairing && !myauth1) { + int nr, authfd; + printf("reading auth data from %s\n", authfile); + authfd = open(authfile, O_RDONLY); + if (authfd < 0) { + perror(authfile); + fprintf(stderr, "No auth data. Need to pair first\n"); + exit(1); + } + nr = read(authfd, authdata, 32); + close(authfd); + if (nr != 32 && nr != 24) { + fprintf(stderr, "bad auth file len %d != 32 or 24\n", nr); + exit(1); + } + // BUG: auth file not portable + memcpy((void *)&myauth1, authdata+16, 4); + memcpy((void *)&myauth2, authdata+20, 4); + memcpy((void *)&myauth3, authdata+24, 4); + memcpy((void *)&myauth4, authdata+28, 4); + memcpy((void *)&mydev, authdata+12, 4); + memcpy((void *)&myid, authdata+4, 4); + if (dbg) + fprintf(stderr, "dev %d auth %08x %08x %08x %08x id %08x\n", + mydev, myauth1, myauth2, myauth3, myauth4, myid); + } + // bind to watch + if (!donebind && devid) { + donebind = 1; + newfreq = 0x46; + ack.code = 0x44; ack.atype = 2; ack.c1 = newfreq ? newfreq : 0x32; ack.c2 = 0x04; + ack.id = myid; + ANT_SendAcknowledgedData(chan, (void *)&ack); // bind + } else { + if (dbg) printf("donebind %d devid %x\n", donebind, devid); + } + break; + case 1: + if (dbg) printf("case 1 %x\n", peerdev); + if (peerdev) { + if (dbg) printf("case 1 peerdev\n"); + // if watch has sent id + if (mydev != 0 && peerdev != mydev) { + fprintf(stderr, "Don't know this device %08x != %08x\n", peerdev, mydev); + } else if (!sentauth && !waitauth) { + if (dbg) printf("case 1 diffdev\n"); + assert(sizeof auth == AUTHSIZE); + auth.code = 0x44; auth.atype = 4; auth.phase = 3; auth.u1 = 12; + auth.id = myid; auth.auth1 = myauth1; auth.auth2 = myauth2; + auth.auth3 = myauth3; auth.auth4 = myauth4; + auth.fill1 = auth.fill2 = 0; + sentauth = 1; + ANT_SendBurstTransfer(chan, (void *)&auth, (sizeof auth)/8); // send our auth data + } + } + if (dbg) printf("case 1 cid %x myid %x\n", cid, myid); + if (!sentack2 && cid == myid && !waitauth) { + sentack2 = 1; + if (dbg) printf("sending ack2\n"); + // if it did bind to me before someone else + ack.code = 0x44; ack.atype = 4; ack.c1 = 0x01; ack.c2 = 0x00; + ack.id = myid; + ANT_SendAcknowledgedData(chan, (void *)&ack); // request id + } + break; + case 2: + // successfully authenticated + if (!downloadstarted) { + downloadstarted = 1; + downloadingfilenum = -1; + if (dbg) printf("downloading directory\n"); + start_download(chan, 0); + } + if (downloadfinished) { + if (dbg) printf("finished download\n"); + ack.code = 0x44; ack.atype = 3; ack.c1 = 0x00; ack.c2 = 0x00; ack.id = 0; + if (!passive) ANT_SendAcknowledgedData(chan, (void *)&ack); // tell garmin we're finished + } + break; + case 3: + if (pairing) { + // waiting for the user to pair + printf("Please confirm pairing on watch\n"); + waitauth = 2; // next burst data is auth data + } else { + if (dbg) printf("not sure why in phase 3\n"); + if (!sentgetv) { + sentgetv = 1; + //ANT_SendBurstTransferA(chan, getversion, strlen(getversion)/16); + } + } + break; + default: + if (dbg) fprintf(stderr, "Unknown phase %d\n", phase); + break; + } + break; + } + case EVENT_RX_BURST_PACKET: + // now handled in coalesced burst below + if (dbg) printf("burst\n"); + break; + case EVENT_RX_FAKE_BURST: + if (dbg) printf("rxfake burst pairing %d waitauth %d\n", pairing, waitauth); + blsize = *(int *)(cbuf+4); // FIXME: not endian-safe + memcpy(&blast, cbuf+8, 4); // FIXME: not endian-safe + if (dbg) { + printf("fake burst %d %lx ", blsize, (long)blast); + for (i = 0; i < blsize && i < 64; i++) + printf("%02x", blast[i]); + printf("\n"); + for (i = 0; i < blsize; i++) + if (isprint(blast[i])) + printf("%c", blast[i]); + else + printf("."); + printf("\n"); + } + if (blsize >= 10 && blast[8] == 0x44 && blast[9] == 0x89) { + if (downloadingfilenum == -1) { + if (dbg) printf("received ant-fs directory\n"); + decode_antfs_dir(blast, blsize); + + if (antfsdir_used > 0) { + downloadingfilenum = 0; + if (dbg) printf("downloading first file (%d)\n", antfsdir[downloadingfilenum].fileno); + start_download(chan, antfsdir[downloadingfilenum].fileno); + } + } else { + save_antfs_file(blast, blsize); + + if (downloadingfilenum >= antfsdir_used - 1) { + if (dbg) printf("all files downloaded\n"); + downloadfinished = 1; + } else { + ++downloadingfilenum; + if (dbg) printf("downloading next file (%d)\n", antfsdir[downloadingfilenum].fileno); + start_download(chan, antfsdir[downloadingfilenum].fileno); + } + } + } + if (sentauth) { + } else if (!nopairing && pairing && blast) { + memcpy(&peerdev, blast+12, 4); + if (dbg) + printf("watch id %08x waitauth %d\n", peerdev, waitauth); + if (mydev != 0 && peerdev != mydev) { + fprintf(stderr, "Don't know this device %08x != %08x\n", peerdev, mydev); + exit(1); + } + if (waitauth == 2) { + int nw, authfd; + // should be receiving auth data + if (nowriteauth) { + printf("Not overwriting auth data\n"); + exit(1); + } + printf("storing auth data in %s\n", authfile); + authfd = open(authfile, O_WRONLY|O_CREAT, 0644); + if (authfd < 0) { + perror(authfile); + exit(1); + } + nw = write(authfd, blast, blsize); + if (nw != blsize) { + fprintf(stderr, "auth write failed fd %d %d\n", authfd, nw); + perror("write"); + exit(1); + } + close(authfd); + //exit(1); + pairing = 0; + waitauth = 0; + reset = 1; + } + if (pairing && !waitauth) { + //assert(sizeof pair == PAIRSIZE); + pair.code = 0x44; pair.atype = 4; pair.phase = 2; pair.id = myid; + bzero(pair.devname, sizeof pair.devname); + //if (peerdev <= 9999999) // only allow 7 digits + //sprintf(pair.devname, "%u", peerdev); + strcpy(pair.devname, fname); + //else + // fprintf(stderr, "pair dev name too large %08x \"%d\"\n", peerdev, peerdev); + pair.u1 = strlen(pair.devname); + printf("sending pair data for dev %s\n", pair.devname); + waitauth = 1; + ANT_SendBurstTransfer(chan, (void *)&pair, (sizeof pair)/8) ; // send pair data + } else { + if (dbg) printf("not pairing\n"); + } + } else if (!gotwatchid && (lastphase == 1)) { + static int once = 0; + gotwatchid = 1; + // garmin sending authentication/identification data + if (!once) { + once = 1; + if (dbg) + fprintf(stderr, "id data: "); + } + if (dbg) + for (i = 0; i < blsize; i++) + fprintf(stderr, "%02x", blast[i]); + if (dbg) + fprintf(stderr, "\n"); + memcpy(&peerdev, blast+12, 4); + if (dbg) + printf("watch id %08x\n", peerdev); + if (mydev != 0 && peerdev != mydev) { + fprintf(stderr, "Don't know this device %08x != %08x\n", peerdev, mydev); + exit(1); + } + } + if (dbg) printf("continuing after burst\n"); + break; + } + return 1; +} + +uchar +revent(uchar chan, uchar event) +{ + int i; + + if (dbg) printf("revent %02x %02x\n", chan, event); + switch (event) { + case EVENT_TRANSFER_TX_COMPLETED: + if (dbg) printf("Transfer complete %02x\n", ebuf[1]); + break; + case TRANSFER_SEQUENCE_NUMBER_ERROR: + if (dbg) printf("Transfer sequence number error %02x\n", ebuf[1]); + break; + case EVENT_TRANSFER_RX_FAILED: + case EVENT_TRANSFER_TX_FAILED: + if (dbg) printf("Transfer failed %d\n", ebuf[1]); + + // this may not be the best idea in all cases... + if (downloadingfilenum >= 0) { + start_download(chan, antfsdir[downloadingfilenum].fileno); + } + break; + case INVALID_MESSAGE: + printf("Invalid message %02x\n", ebuf[1]); + break; + case RESPONSE_NO_ERROR: + switch (ebuf[1]) { + case MESG_ASSIGN_CHANNEL_ID: + ANT_AssignChannelEventFunction(chan, chevent, cbuf); + break; + case MESG_OPEN_CHANNEL_ID: + printf("channel open, waiting for broadcast...\n"); + break; + default: + if (dbg) printf("Message %02x NO_ERROR\n", ebuf[1]); + break; + } + break; + case MESG_CHANNEL_ID_ID: + devid = ebuf[1]+ebuf[2]*256; + if (mydev == 0 || devid == mydev%65536) { + if (dbg) + printf("devid %08x myid %08x\n", devid, myid); + } else { + printf("Ignoring unknown device %08x, mydev %08x\n", devid, mydev); + devid = sentid = 0; // reset + } + break; + case MESG_NETWORK_KEY_ID: + case MESG_SEARCH_WAVEFORM_ID: + case MESG_OPEN_CHANNEL_ID: + printf("response event %02x code %02x\n", event, ebuf[2]); + for (i = 0; i < 8; i++) + fprintf(stderr, "%02x", ebuf[i]); + fprintf(stderr, "\n"); + break; + case MESG_CAPABILITIES_ID: + if (dbg) + printf("capabilities chans %d nets %d opt %02x adv %02x\n", + ebuf[0], ebuf[1], ebuf[2], ebuf[3]); + break; + case MESG_CHANNEL_STATUS_ID: + if (dbg) + printf("channel status %d\n", ebuf[1]); + break; + case EVENT_RX_FAIL: + // ignore this + // TODO: this could be an indication the transfer has + // failed. handle here or time out? + break; + default: + printf("Unhandled response event %02x\n", event); + break; + } + return 1; +} + +int +main(int ac, char *av[]) +{ + int devnum = 0; + int chan = 0; + int net = 0; + int chtype = 0; // wildcard + int devno = 0; // wildcard + int devtype = 1; // wildcard + int manid = 5; // wildcard + int freq = 0x32; // garmin specific radio frequency + int srchto = 255; // max timeout + int waveform = 0x0053; // aids search somehow + int c; + extern char *optarg; + extern int optind, opterr, optopt; + + setlinebuf(stdout); + setlinebuf(stderr); + + // default auth file // + if (getenv("HOME")) { + authfile = malloc(strlen(getenv("HOME"))+strlen("/.gant")+1); + if (authfile) + sprintf(authfile, "%s/.gant", getenv("HOME")); + } + progname = av[0]; + while ((c = getopt(ac, av, "a:d:i:m:PpvDrnzf:")) != -1) { + switch(c) { + case 'a': + authfile = optarg; + break; + case 'f': + fname = optarg; + break; + case 'd': + devnum = atoi(optarg); + break; + case 'i': + myid = atoi(optarg); + break; + case 'm': + mydev = atoi(optarg); + break; + case 'p': + passive = 1; + break; + case 'P': + passive = 1; + break; + case 'v': + verbose = 1; + break; + case 'D': + dbg = 1; + break; + case 'r': + reset = 1; + break; + case 'n': + nowriteauth = 1; + break; + case 'z': + nopairing = 1; + break; + default: + fprintf(stderr, "unknown option %s\n", optarg); + usage(); + } + } + + ac -= optind; + av += optind; + + if ((!passive && !authfile) || ac) + usage(); + + if (!ANT_Init(devnum, 0)) { // should be 115200 but doesn't fit into a short + fprintf(stderr, "open dev %d failed\n", devnum); + exit(1); + } + ANT_ResetSystem(); + ANT_AssignResponseFunction(revent, ebuf); + //ANT_RequestMessage(chan, MESG_CHANNEL_STATUS_ID); //informative + ANT_SetNetworkKeya(net, ANTSPT_KEY); + ANT_AssignChannel(chan, chtype, net); + // Wali: changed order of the following seq. according windows + ANT_SetChannelPeriod(chan, period); + ANT_SetChannelSearchTimeout(chan, srchto); + //ANT_RequestMessage(chan, MESG_CAPABILITIES_ID); //informative + ANT_SetChannelRFFreq(chan, freq); + ANT_SetSearchWaveform(chan, waveform); + ANT_SetChannelId(chan, devno, devtype, manid); + ANT_OpenChannel(chan); + ANT_RequestMessage(chan, MESG_CHANNEL_STATUS_ID); //informative + + if (dbg) printf("waiting...\n"); + + // everything handled in event functions + for(;;) + sleep(10); +} diff --git a/gant.c b/gant.c deleted file mode 100644 index 3a90df4..0000000 --- a/gant.c +++ /dev/null @@ -1,1203 +0,0 @@ -// copyright 2008-2009 paul@ant.sbrk.co.uk. released under GPLv3 -// copyright 2009-2009 Wali -// vers 0.6t -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include - -#include "antdefs.h" - -// all version numbering according ant agent for windows 2.2.1 -char *releasetime = "Jul 30 2009, 17:42:56"; -uint majorrelease = 2; -uint minorrelease = 2; -uint majorbuild = 7; -uint minorbuild = 0; - -double round(double); - -int gottype; -int sentauth; -int gotwatchid; -int nopairing; -int nowriteauth; -int reset; -int dbg = 0; -int seenphase0 = 0; -int lastphase; -int sentack2; -int newfreq = 0; -int period = 0x1000; // garmin specific broadcast period -int donebind = 0; -int sentgetv; -char *fname = "garmin"; - -static char ANTSPT_KEY[] = "A8A423B9F55E63C1"; // ANT+Sport key - -static uchar ebuf[MESG_DATA_SIZE]; // response event data gets stored here -static uchar cbuf[MESG_DATA_SIZE]; // channel event data gets stored here - -int passive; -int semipassive; -int verbose; - -int downloadfinished = 0; -int downloadstarted = 0; -int sentid = 0; - -uint mydev = 0; -uint peerdev; -uint myid; -uint devid; -uint myauth1; -uint myauth2; -char authdata[32]; -uint pairing; -uint isa50; -uint isa405; -uint waitauth; -int nphase0; -char modelname[256]; -char devname[256]; -ushort part = 0; -ushort ver = 0; -uint unitid = 0; - - -//char *getversion = "440dffff00000000fe00000000000000"; -//char *getgpsver = "440dffff0000000006000200ff000000"; -char *acks[] = { - "fe00000000000000", // get version - 255, 248, 253 - "0e02000000000000", // device short name (fr405a) - 525 -// "1c00020000000000", // no data - "0a0002000e000000", // unit id - 38 - "0a00020002000000", // send position - "0a00020005000000", // send time - "0a000200ad020000", // 4 byte something? 0x10270000 = 10000 dec - 1523 - "0a000200c6010000", // 3 x 4 ints? - 994 - "0a00020035020000", // guessing this is # trackpoints per run - 1066 - "0a00020097000000", // load of software versions - 247 - "0a000200c2010000", // download runs - 27 (#runs), 990?, 12? - "0a00020075000000", // download laps - 27 (#laps), 149 laps, 12? - "0a00020006000000", // download trackpoints - 1510/99(run marker), ..1510,12 - "0a000200ac020000", - "" -}; -int sentcmd; - -uchar clientid[3][8]; - -int authfd = -1; -char *authfile; -int outfd; // output file -char *fn = "default_output_file"; -char *progname; - -#define BSIZE 8*10000 -//uchar blast[BSIZE]; // should be like that, but not working -uchar *blast = 0; // first time reading not initialized, but why it is working reading from adr 0? - -int blsize = 0; -int bused = 0; -int lseq = -1; - -/* round a float as garmin does it! */ -/* shoot me for writing this! */ -char * -ground(double d) -{ - int neg = 0; - static char res[30]; - ulong ival; - ulong l; /* hope it doesn't overflow */ - - if (d < 0) { - neg = 1; - d = -d; - } - ival = floor(d); - d -= ival; - l = floor(d*100000000); - if (l % 10 >= 5) - l = l/10+1; - else - l = l/10; - sprintf(res,"%s%ld.%07ld", neg?"-":"", ival, l); - return res; -} - -char * -timestamp(void) -{ - struct timeval tv; - static char time[50]; - struct tm *tmp; - - gettimeofday(&tv, 0); - tmp = gmtime(&tv.tv_sec); - - sprintf(time, "%02d:%02d:%02d.%02d", - tmp->tm_hour, tmp->tm_min, tmp->tm_sec, (int)tv.tv_usec/10000); - return time; -} - -uint -randno(void) -{ - uint r; - - int fd = open("/dev/urandom", O_RDONLY); - if (fd > 0) { - read(fd, &r, sizeof r); - close(fd); - } - return r; -} - -void -print_tcx_header(FILE *tcxfile) -{ - fprintf(tcxfile, "\n"); - fprintf(tcxfile, "\n\n"); - fprintf(tcxfile, " \n"); - return; -} - -void -print_tcx_footer(FILE *tcxfile) -{ - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %s\n", devname); - fprintf(tcxfile, " %u\n", unitid); - fprintf(tcxfile, " %u\n", part); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %u\n", ver/100); - fprintf(tcxfile, " %u\n", ver - ver/100*100); - fprintf(tcxfile, " 0\n"); - fprintf(tcxfile, " 0\n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n\n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " Garmin ANT Agent(tm)\n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %u\n", majorrelease); - fprintf(tcxfile, " %u\n", minorrelease); - fprintf(tcxfile, " %u\n", majorbuild); - fprintf(tcxfile, " %u\n", minorbuild); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " Release\n"); - fprintf(tcxfile, " \n", releasetime); - fprintf(tcxfile, " sqa\n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " EN\n"); - fprintf(tcxfile, " 006-A0214-00\n"); - fprintf(tcxfile, " \n\n"); - fprintf(tcxfile, "\n"); - return; -} - - -#pragma pack(1) -struct ack_msg { - uchar code; - uchar atype; - uchar c1; - uchar c2; - uint id; -}; - -struct auth_msg { - uchar code; - uchar atype; - uchar phase; - uchar u1; - uint id; - uint auth1; - uint auth2; - uint fill1; - uint fill2; -}; - -struct pair_msg { - uchar code; - uchar atype; - uchar phase; - uchar u1; - uint id; - char devname[16]; -}; - -#pragma pack() -#define ACKSIZE 8 // above structure must be this size -#define AUTHSIZE 24 // ditto -#define PAIRSIZE 16 -#define MAXLAPS 256 // max of saving laps data before output with trackpoint data -#define MAXTRACK 256 // max number of tracks to be saved per download - -decode(ushort bloblen, ushort pkttype, ushort pktlen, int dsize, uchar *data) -{ - int i; - int j; - int hr; - int hr_av; - int hr_max; - int cal; - float tsec; - float max_speed; - int cad; - int u1, u2; - int doff = 20; - char model[256]; - char gpsver[256]; - float alt; - float dist; - uint tv; - uint tv_previous = 0; - time_t ttv; - char tbuf[100]; - struct tm *tmp; - double lat, lon; - uint nruns; - uint tv_lap; - static uchar lapbuf[MAXLAPS][48]; - static ushort lap = 0; - static ushort lastlap = 0; - static ushort track = 0; - static short previoustrack_id = -1; - static short track_id = -1; - static short firsttrack_id = -1; - static short firstlap_id = -1; - static ushort firstlap_id_track[MAXTRACK]; - static uchar sporttyp_track[MAXTRACK]; - static FILE *tcxfile = NULL; - static ushort track_pause = 0; - - - printf("decode %d %d %d %d\n", bloblen, pkttype, pktlen, dsize); - switch (pkttype) { - case 255: - memset(model, 0, sizeof model); - memcpy(model, data+doff+4, dsize-4); - part=data[doff]+data[doff+1]*256; - ver=data[doff+2]+data[doff+3]*256; - printf("%d Part#: %d ver: %d Name: %s\n", pkttype, - part, ver, model); - break; - case 248: - memset(gpsver, 0, sizeof gpsver); - memcpy(gpsver, data+doff, dsize); - printf("%d GPSver: %s\n", pkttype, - gpsver); - break; - case 253: - printf("%d Unknown\n", pkttype); - for (i = 0; i < pktlen; i += 3) - printf("%d.%d.%d\n", data[doff+i], data[doff+i+1], data[doff+i+2]); - break; - case 525: - memset(devname, 0, sizeof devname); - memcpy(devname, data+doff, dsize); - printf("%d Devname %s\n", pkttype, devname); - break; - case 12: - printf("%d xfer complete", pkttype); - for (i = 0; i < pktlen; i += 2) - printf(" %u", data[doff+i] + data[doff+i+1]*256); - printf("\n"); - switch (data[doff] + data[doff+1]*256) { - case 6: - // last file completed, add footer and close file - print_tcx_footer(tcxfile); - fclose(tcxfile); - break; - case 117: - break; - case 450: - break; - default: - break; - } - break; - case 38: - unitid = data[doff] + data[doff+1]*256 + - data[doff+2]*256*256 + data[doff+3]*256*256*256; - printf("%d unitid %u\n", pkttype, unitid); - break; - case 27: - nruns = data[doff] + data[doff+1] * 256; - printf("%d nruns %u\n", pkttype, nruns); - break; - case 1523: - case 994: - case 1066: - printf("%d ints?", pkttype); - for (i = 0; i < pktlen; i += 4) - printf(" %u", data[doff+i] + data[doff+i+1]*256 + - data[doff+i+2]*256*256 + data[doff+i+3]*256*256*256); - printf("\n"); - break; - case 14: - printf("%d time: ", pkttype); - printf("%02u-%02u-%u %02u:%02u:%02u\n", data[doff], data[doff+1], data[doff+2] + data[doff+3]*256, - data[doff+4], data[doff+6], data[doff+7]); - break; - case 17: - printf("%d position ? ", pkttype); - for (i = 0; i < pktlen; i += 4) - printf(" %u", data[doff+i] + data[doff+i+1]*256 + - data[doff+i+2]*256*256 + data[doff+i+3]*256*256*256); - printf("\n"); - break; - case 99: - printf("%d trackindex %u\n", pkttype, data[doff] + data[doff+1]*256); - printf("%d shorts?", pkttype); - for (i = 0; i < pktlen; i += 2) - printf(" %u", data[doff+i] + data[doff+i+1]*256); - printf("\n"); - track_id = data[doff] + data[doff+1]*256; - break; - case 990: - printf("%d track %u lap %u-%u sport %u\n", pkttype, - data[doff] + data[doff+1]*256, data[doff+2] + data[doff+3]*256, - data[doff+4] + data[doff+5]*256, data[doff+6]); - printf("%d shorts?", pkttype); - for (i = 0; i < pktlen; i += 2) - printf(" %u", data[doff+i] + data[doff+i+1]*256); - printf("\n"); - if (firstlap_id == -1) firstlap_id = data[doff+2] + data[doff+3]*256; - if (firsttrack_id == -1) firsttrack_id = data[doff] + data[doff+1]*256; - track = (data[doff] + data[doff+1]*256) - firsttrack_id; - if (track < MAXTRACK) { - firstlap_id_track[track] = data[doff+2] + data[doff+3]*256; - sporttyp_track[track] = data[doff+6]; - } else { - printf("Error: track and lap data temporary array out of range %u!\n", track); - } - break; - case 1510: - printf("%d waypoints", pkttype); - for (i = 0; i < 4 && i < pktlen; i += 4) - printf(" %u", data[doff+i] + data[doff+i+1]*256 + - data[doff+i+2]*256*256 + data[doff+i+3]*256*256*256); - printf("\n"); - // if trackpoints are split into more than one message 1510, do not add xml head again - if (previoustrack_id != track_id) { - // close previous file if it is not the first track to be downloaded - if (previoustrack_id > -1) { - // add xml footer and close file, the next file will be open further down - print_tcx_footer(tcxfile); - fclose(tcxfile); - } - // use first lap starttime as filename - lap = firstlap_id_track[track_id-firsttrack_id] - firstlap_id; - if (dbg) printf("lap %u track_id %u firsttrack_id %u firstlap_id %u\n", lap, track_id, firsttrack_id, firstlap_id); - tv_lap = lapbuf[lap][4] + lapbuf[lap][5]*256 + - lapbuf[lap][6]*256*256 + lapbuf[lap][7]*256*256*256; - ttv = tv_lap + 631065600; // garmin epoch offset - strftime(tbuf, sizeof tbuf, "%Y-%m-%d-%H%M%S.TCX", localtime(&ttv)); - // open file and start with header of xml file - tcxfile = fopen(tbuf, "wt"); - print_tcx_header(tcxfile); - } - for (i = 4; i < pktlen; i += 24) { - tv = (data[doff+i+8] + data[doff+i+9]*256 + - data[doff+i+10]*256*256 + data[doff+i+11]*256*256*256); - tv_lap = lapbuf[lap][4] + lapbuf[lap][5]*256 + - lapbuf[lap][6]*256*256 + lapbuf[lap][7]*256*256*256; - if ((tv > tv_lap || (tv == tv_lap && lap == (firstlap_id_track[track_id-firsttrack_id] - firstlap_id))) && lap <= lastlap) { - ttv = tv_lap + 631065600; // garmin epoch offset - strftime(tbuf, sizeof tbuf, "%Y-%m-%dT%H:%M:%SZ", gmtime(&ttv)); - tsec = (lapbuf[lap][8] + lapbuf[lap][9]*256 + - lapbuf[lap][10]*256*256 + lapbuf[lap][11]*256*256*256); - memcpy((void *)&dist, &lapbuf[lap][12], 4); - memcpy((void *)&max_speed, &lapbuf[lap][16], 4); - cal = lapbuf[lap][36] + lapbuf[lap][37]*256; - hr_av = lapbuf[lap][38]; - hr_max = lapbuf[lap][39]; - cad = lapbuf[lap][41]; - if (lap == firstlap_id_track[track_id-firsttrack_id] - firstlap_id) { - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %s\n", tbuf); - } else { - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - } - fprintf(tcxfile, " \n", tbuf); - fprintf(tcxfile, " %s\n", ground(tsec/100)); - fprintf(tcxfile, " %s\n", ground(dist)); - fprintf(tcxfile, " %s\n", ground(max_speed)); - fprintf(tcxfile, " %d\n", cal); - if (hr_av > 0) { - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %d\n", hr_av); - fprintf(tcxfile, " \n"); - } - if (hr_max > 0) { - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %d\n", hr_max); - fprintf(tcxfile, " \n"); - } - fprintf(tcxfile, " "); - switch (lapbuf[lap][40]) { - case 0: fprintf(tcxfile, "Active"); break; - case 1: fprintf(tcxfile, "Rest"); break; - default: fprintf(tcxfile, "unknown value: %d", lapbuf[lap][40]); - } - fprintf(tcxfile, "\n"); - // for bike the average cadence of this lap is here - if (sporttyp_track[track_id-firsttrack_id] == 1) { - if (cad != 255) { - fprintf(tcxfile, " %d\n", cad); - } - } - fprintf(tcxfile, " "); - switch(lapbuf[lap][42]) { - case 4: fprintf(tcxfile, "Heartrate"); break; - case 3: fprintf(tcxfile, "Time"); break; - case 2: fprintf(tcxfile, "Location"); break; - case 1: fprintf(tcxfile, "Distance"); break; - case 0: fprintf(tcxfile, "Manual"); break; - default: fprintf(tcxfile, "unknown value: %d", lapbuf[lap][42]); - } - fprintf(tcxfile, "\n"); - // I prefere the average run cadence here than at the end of this lap according windows ANTagent - if (sporttyp_track[track_id-firsttrack_id] == 0) { - if (cad != 255) { - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %d\n", cad); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - } - } - fprintf(tcxfile, " \n"); - lap++; - // if the previous trackpoint has same second as lap time display the trackpoint again - if (dbg) printf("i %u tv %d tv_lap %d tv_previous %d\n", i, tv, tv_lap, tv_previous); - if (tv_previous == tv_lap) { - i -= 24; - tv = tv_previous; - } - track_pause = 0; - } // end of if (tv >= tv_lap && lap <= lastlap) - ttv = tv+631065600; // garmin epoch offset - tmp = gmtime(&ttv); - strftime(tbuf, sizeof tbuf, "%Y-%m-%dT%H:%M:%SZ", tmp); // format for printing - memcpy((void *)&alt, data+doff+i+12, 4); - memcpy((void *)&dist, data+doff+i+16, 4); - lat = (data[doff+i] + data[doff+i+1]*256 + - data[doff+i+2]*256*256 + data[doff+i+3]*256*256*256)*180.0/0x80000000; - lon = (data[doff+i+4] + data[doff+i+5]*256 + - data[doff+i+6]*256*256 + data[doff+i+7]*256*256*256)*180.0/0x80000000; - hr = data[doff+i+20]; - cad = data[doff+i+21]; - u1 = data[doff+i+22]; - u2 = data[doff+i+23]; - if (dbg) printf("lat %.10g lon %.10g hr %d cad %d u1 %d u2 %d tv %d %s alt %f dist %f %02x %02x%02x%02x%02x\n", lat, lon, - hr, cad, u1, u2, tv, tbuf, alt, dist, data[doff+i+3], data[doff+i+16], data[doff+i+17], data[doff+i+18], data[doff+i+19]); - // track pause only if following trackpoint is aswell 'timemarker' with utopic distance - if (track_pause && dist > (float)40000000) { - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - } - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n",tbuf); - if (lat < 90) { - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %s\n", - ground(lat)); - fprintf(tcxfile, " %s\n", - ground(lon)); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %s\n", ground(alt)); - } - // last trackpoint has utopic distance, 40000km should be enough, hack? - if (dist < (float)40000000) { - fprintf(tcxfile, " %s\n", ground(dist)); - } - if (hr > 0) { - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %d\n", hr); - fprintf(tcxfile, " \n"); - } - // for bikes the cadence is written here and for the footpod in , why garmin? - if (sporttyp_track[track_id-firsttrack_id] == 1) { - if (cad != 255) { - fprintf(tcxfile, " %d\n", cad); - } - } - if (dist < (float)40000000) { - fprintf(tcxfile, " %s\n", u1 ? "Present" : "Absent"); - if (u1 == 1 || cad != 255) { - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - } else { - fprintf(tcxfile, "Footpod\""); - if (cad != 255) { - fprintf(tcxfile, ">\n"); - fprintf(tcxfile, " %d\n", cad); - fprintf(tcxfile, " \n"); - } else { - fprintf(tcxfile, "/>\n"); - } - } - fprintf(tcxfile, " \n"); - } - track_pause = 0; - } - fprintf(tcxfile, " \n"); - // maybe if we recieve utopic position and distance this tells pause in the run (stop and go) if not begin or end of lap - if (dist > (float)40000000 && track_pause == 0) { - track_pause = 1; - if (dbg) printf("track pause (stop and go)\n"); - } else { - track_pause = 0; - } - tv_previous = tv; - } // end of for (i = 4; i < pktlen; i += 24) - previoustrack_id = track_id; - break; - case 149: - printf("%d Lap data id: %u %u\n", pkttype, - data[doff] + data[doff+1]*256, data[doff+2] + data[doff+3]*256); - if (lap < MAXLAPS) { - memcpy((void *)&lapbuf[lap][0], data+doff, 48); - lastlap = lap; - lap++; - } - break; - case 247: - memset(modelname, 0, sizeof modelname); - memcpy(modelname, data+doff+88, dsize-88); - printf("%d Device name %s\n", pkttype, modelname); - break; - default: - printf("don't know how to decode packet type %d\n", pkttype); - for (i = doff; i < dsize && i < doff+pktlen; i++) - printf("%02x", data[i]); - printf("\n"); - for (i = doff; i < dsize && i < doff+pktlen; i++) - if (isprint(data[i])) - printf("%c", data[i]); - else - printf("."); - printf("\n"); - } -} - -void -usage(void) -{ - fprintf(stderr, "Usage: %s -a authfile\n" - "[ -o outfile ]\n" - "[ -d devno ]\n" - "[ -i id ]\n" - "[ -m mydev ]\n" - "[ -p ]\n", - progname - ); - exit(1); -} - -uchar -chevent(uchar chan, uchar event) -{ - uchar seq; - uchar last; - uchar status; - uchar phase; - uint newdata; - struct ack_msg ack; - struct auth_msg auth; - struct pair_msg pair; - uint id; - int i; - uint cid; - if (dbg) printf("chevent %02x %02x\n", chan, event); - - if (event == EVENT_RX_BROADCAST) { - status = cbuf[1] & 0xd7; - newdata = cbuf[1] & 0x20; - phase = cbuf[2]; - } - cid = cbuf[4]+cbuf[5]*256+cbuf[6]*256*256+cbuf[7]*256*256*256; - memcpy((void *)&id, cbuf+4, 4); - - if (dbg) - fprintf(stderr, "cid %08x myid %08x\n", cid, myid); - if (dbg && event != EVENT_RX_BURST_PACKET) { - fprintf(stderr, "chan %d event %02x channel open: ", chan, event); - for (i = 0; i < 8; i++) - fprintf(stderr, "%02x", cbuf[i]); - fprintf(stderr, "\n"); - } - - switch (event) { - case EVENT_RX_BROADCAST: - lastphase = phase; // store the last phase we see the watch broadcast - if (dbg) printf("lastphase %d\n", lastphase); - if (!pairing && !nopairing) - pairing = cbuf[1] & 8; - if (!gottype) { - gottype = 1; - isa50 = cbuf[1] & 4; - isa405 = cbuf[1] & 1; - if ((isa50 && isa405) || (!isa50 && !isa405)) { - fprintf(stderr, "50 %d and 405 %d\n", isa50, isa405); - exit(1); - } - } - if (verbose) { - switch (phase) { - case 0: - fprintf(stderr, "%s BC0 %02x %d %d %d PID %d %d %d %c%c\n", - timestamp(), - cbuf[0], cbuf[1] & 0xd7, cbuf[2], cbuf[3], - cbuf[4]+cbuf[5]*256, cbuf[6], cbuf[7], - (cbuf[1] & 0x20) ? 'N' : ' ', (cbuf[1] & 0x08) ? 'P' : ' ' - ); - break; - case 1: - fprintf(stderr, "%s BC1 %02x %d %d %d CID %08x %c%c\n", - timestamp(), - cbuf[0], cbuf[1] & 0xd7, cbuf[2], cbuf[3], cid, - (cbuf[1] & 0x20) ? 'N' : ' ', (cbuf[1] & 0x08) ? 'P' : ' ' - ); - break; - fprintf(stderr, "%s BCX %02x %d %d %d PID %d %d %d %c%c\n", - timestamp(), - cbuf[0], cbuf[1] & 0xd7, cbuf[2], cbuf[3], - cbuf[4]+cbuf[5]*256, cbuf[6], cbuf[7], - (cbuf[1] & 0x20) ? 'N' : ' ', (cbuf[1] & 0x08) ? 'P' : ' ' - ); - default: - break; - } - } - - if (dbg) - printf("watch status %02x stage %d id %08x\n", status, phase, id); - - if (!sentid) { - sentid = 1; - ANT_RequestMessage(chan, MESG_CHANNEL_ID_ID); /* request sender id */ - } - - // if we don't see a phase 0 message first, reset the watch - if (reset || (phase != 0 && !seenphase0)) { - fprintf(stderr, "resetting\n"); - ack.code = 0x44; ack.atype = 3; ack.c1 = 0x00; ack.c2 = 0x00; ack.id = 0; - ANT_SendAcknowledgedData(chan, (void *)&ack); // tell garmin we're finished - sleep(1); - exit(1); - } - switch (phase) { - case 0: - seenphase0 = 1; - nphase0++; - if (nphase0 % 10 == 0) - donebind = 0; - if (newfreq) { - // switch to new frequency - ANT_SetChannelPeriod(chan, period); - ANT_SetChannelSearchTimeout(chan, 3); - ANT_SetChannelRFFreq(chan, newfreq); - newfreq = 0; - } - // phase 0 seen after reset at end of download - if (downloadfinished) { - fprintf(stderr, "finished\n"); - exit(0); - } - // generate a random id if pairing and user didn't specify one - if (pairing && !myid) { - myid = randno(); - fprintf(stderr, "pairing, using id %08x\n", myid); - } - // need id codes from auth file if not pairing - // TODO: handle multiple watches - // BUG: myauth1 should be allowed to be 0 - if (!pairing && !myauth1) { - int nr; - printf("reading auth data from %s\n", authfile); - authfd = open(authfile, O_RDONLY); - if (authfd < 0) { - perror(authfile); - fprintf(stderr, "No auth data. Need to pair first\n"); - exit(1); - } - nr = read(authfd, authdata, 32); - close(authfd); - if (nr != 32 && nr != 24) { - fprintf(stderr, "bad auth file len %d != 32 or 24\n", nr); - exit(1); - } - // BUG: auth file not portable - memcpy((void *)&myauth1, authdata+16, 4); - memcpy((void *)&myauth2, authdata+20, 4); - memcpy((void *)&mydev, authdata+12, 4); - memcpy((void *)&myid, authdata+4, 4); - if (dbg) - fprintf(stderr, "dev %08x auth %08x %08x id %08x\n", - mydev, myauth1, myauth2, myid); - } - // bind to watch - if (!donebind && devid) { - donebind = 1; - if (isa405) - newfreq = 0x32; - ack.code = 0x44; ack.atype = 2; ack.c1 = isa50 ? 0x32 : newfreq; ack.c2 = 0x04; - ack.id = myid; - ANT_SendAcknowledgedData(chan, (void *)&ack); // bind - } else { - if (dbg) printf("donebind %d devid %x\n", donebind, devid); - } - break; - case 1: - if (dbg) printf("case 1 %x\n", peerdev); - if (peerdev) { - if (dbg) printf("case 1 peerdev\n"); - // if watch has sent id - if (mydev != 0 && peerdev != mydev) { - fprintf(stderr, "Don't know this device %08x != %08x\n", peerdev, mydev); - } else if (!sentauth && !waitauth) { - if (dbg) printf("case 1 diffdev\n"); - assert(sizeof auth == AUTHSIZE); - auth.code = 0x44; auth.atype = 4; auth.phase = 3; auth.u1 = 8; - auth.id = myid; auth.auth1 = myauth1; auth.auth2 = myauth2; - auth.fill1 = auth.fill2 = 0; - sentauth = 1; - ANT_SendBurstTransfer(chan, (void *)&auth, (sizeof auth)/8); // send our auth data - } - } - if (dbg) printf("case 1 cid %x myid %x\n", cid, myid); - if (!sentack2 && cid == myid && !waitauth) { - sentack2 = 1; - if (dbg) printf("sending ack2\n"); - // if it did bind to me before someone else - ack.code = 0x44; ack.atype = 4; ack.c1 = 0x01; ack.c2 = 0x00; - ack.id = myid; - ANT_SendAcknowledgedData(chan, (void *)&ack); // request id - } - break; - case 2: - // successfully authenticated - if (!downloadstarted) { - downloadstarted = 1; - if (dbg) printf("starting download\n"); - ack.code = 0x44; ack.atype = 6; ack.c1 = 0x01; ack.c2 = 0x00; ack.id = 0; - //ANT_SendAcknowledgedData(chan, (void *)&ack); // tell garmin to start upload - } - if (downloadfinished) { - if (dbg) printf("finished download\n"); - ack.code = 0x44; ack.atype = 3; ack.c1 = 0x00; ack.c2 = 0x00; ack.id = 0; - if (!passive) ANT_SendAcknowledgedData(chan, (void *)&ack); // tell garmin we're finished - } - break; - case 3: - if (pairing) { - // waiting for the user to pair - printf("Please press \"View\" on watch to confirm pairing\n"); - waitauth = 2; // next burst data is auth data - } else { - if (dbg) printf("not sure why in phase 3\n"); - if (!sentgetv) { - sentgetv = 1; - //ANT_SendBurstTransferA(chan, getversion, strlen(getversion)/16); - } - } - break; - default: - if (dbg) fprintf(stderr, "Unknown phase %d\n", phase); - break; - } - break; - case EVENT_RX_BURST_PACKET: - // now handled in coalesced burst below - if (dbg) printf("burst\n"); - break; - case EVENT_RX_FAKE_BURST: - if (dbg) printf("rxfake burst pairing %d blast %ld waitauth %d\n", - pairing, (long)blast, waitauth); - blsize = *(int *)(cbuf+4); - memcpy(&blast, cbuf+8, 4); - if (dbg) { - printf("fake burst %d %lx ", blsize, (long)blast); - for (i = 0; i < blsize && i < 64; i++) - printf("%02x", blast[i]); - printf("\n"); - for (i = 0; i < blsize; i++) - if (isprint(blast[i])) - printf("%c", blast[i]); - else - printf("."); - printf("\n"); - } - if (sentauth) { - static int nacksent = 0; - char *ackdata; - static uchar ackpkt[100]; - // ack the last packet - ushort bloblen = blast[14]+256*blast[15]; - ushort pkttype = blast[16]+256*blast[17]; - ushort pktlen = blast[18]+256*blast[19]; - if (bloblen == 0) { - if (dbg) printf("bloblen %d, get next data\n", bloblen); - // request next set of data - ackdata = acks[nacksent++]; - if (!strcmp(ackdata, "")) { // finished - printf("acks finished, resetting\n"); - ack.code = 0x44; ack.atype = 3; ack.c1 = 0x00; - ack.c2 = 0x00; ack.id = 0; - ANT_SendAcknowledgedData(chan, (void *)&ack); // go to idle - sleep(1); - exit(1); - } - if (dbg) printf("got type 0, sending ack %s\n", ackdata); - sprintf(ackpkt, "440dffff00000000%s", ackdata); - } else if (bloblen == 65535) { - // repeat last ack - if (dbg) printf("repeating ack %s\n", ackpkt); - ANT_SendBurstTransferA(chan, ackpkt, strlen(ackpkt)/16); - } else { - if (dbg) printf("non-0 bloblen %d\n", bloblen); - decode(bloblen, pkttype, pktlen, blsize, blast); - sprintf(ackpkt, "440dffff0000000006000200%02x%02x0000", pkttype%256, pkttype/256); - } - if (dbg) printf("received pkttype %d len %d\n", pkttype, pktlen); - if (dbg) printf("acking %s\n", ackpkt); - ANT_SendBurstTransferA(chan, ackpkt, strlen(ackpkt)/16); - } else if (!nopairing && pairing && blast) { - memcpy(&peerdev, blast+12, 4); - if (dbg) - printf("watch id %08x waitauth %d\n", peerdev, waitauth); - if (mydev != 0 && peerdev != mydev) { - fprintf(stderr, "Don't know this device %08x != %08x\n", peerdev, mydev); - exit(1); - } - if (waitauth == 2) { - int nw; - // should be receiving auth data - if (nowriteauth) { - printf("Not overwriting auth data\n"); - exit(1); - } - printf("storing auth data in %s\n", authfile); - authfd = open(authfile, O_WRONLY|O_CREAT, 0644); - if (authfd < 0) { - perror(authfile); - exit(1); - } - nw = write(authfd, blast, blsize); - if (nw != blsize) { - fprintf(stderr, "auth write failed fd %d %d\n", authfd, nw); - perror("write"); - exit(1); - } - close(authfd); - //exit(1); - pairing = 0; - waitauth = 0; - reset = 1; - } - if (pairing && !waitauth) { - //assert(sizeof pair == PAIRSIZE); - pair.code = 0x44; pair.atype = 4; pair.phase = 2; pair.id = myid; - bzero(pair.devname, sizeof pair.devname); - //if (peerdev <= 9999999) // only allow 7 digits - //sprintf(pair.devname, "%u", peerdev); - strcpy(pair.devname, fname); - //else - // fprintf(stderr, "pair dev name too large %08x \"%d\"\n", peerdev, peerdev); - pair.u1 = strlen(pair.devname); - printf("sending pair data for dev %s\n", pair.devname); - waitauth = 1; - if (isa405 && pairing) { - // go straight to storing auth data - waitauth = 2; - } - ANT_SendBurstTransfer(chan, (void *)&pair, (sizeof pair)/8) ; // send pair data - } else { - if (dbg) printf("not pairing\n"); - } - } else if (!gotwatchid && (lastphase == 1)) { - static int once = 0; - gotwatchid = 1; - // garmin sending authentication/identification data - if (!once) { - int i; - once = 1; - if (dbg) - fprintf(stderr, "id data: "); - } - if (dbg) - for (i = 0; i < blsize; i++) - fprintf(stderr, "%02x", blast[i]); - if (dbg) - fprintf(stderr, "\n"); - memcpy(&peerdev, blast+12, 4); - if (dbg) - printf("watch id %08x\n", peerdev); - if (mydev != 0 && peerdev != mydev) { - fprintf(stderr, "Don't know this device %08x != %08x\n", peerdev, mydev); - exit(1); - } - } else if (lastphase == 2) { - int nw; - static int once = 0; - printf("once %d\n", once); - // garmin uploading in response to sendack3 - // in this state we're receiving the workout data - if (!once) { - printf("receiving\n"); - once = 1; - outfd = open(fn, O_WRONLY|O_CREAT, 0644); - if (outfd < 0) { - perror(fn); - exit(1); - } - } - if (last) { - nw = write(outfd, blast, blsize); - if (nw != blsize) { - fprintf(stderr, "data write failed fd %d %d\n", outfd, nw); - perror("write"); - exit(1); - } - close(outfd); - downloadfinished = 1; - } - } else if (0 && last) { - if (dbg) { - fprintf(stderr, "auth response: "); - for (i = 0; i < blsize; i++) - fprintf(stderr, "%02x", cbuf[i]); - fprintf(stderr, "\n"); - } - if (blast[10] == 2) { - fprintf(stderr, "authentication failed\n"); - exit(1); - } - } else if (last) { - fprintf(stderr, "data in state xx: "); - int i; - for (i = 0; i < blsize; i++) - fprintf(stderr, "%02x", blast[i]); - fprintf(stderr, "\n"); - sentcmd = 1000; - switch (sentcmd) { - case 1000: - break; - case 0: - sentcmd++; - //ANT_SendBurstTransferA(chan, getgpsver, strlen(getgpsver)/16); - break; - case 999: - printf("finished\n"); - exit(1); - default: - sleep(1); - sentcmd = 1; - //printf("sending command %d %s\n", sentcmd-1, cmds[sentcmd-1]); - //ANT_SendBurstTransferA(chan, cmds[sentcmd-1], - // strlen(cmds[sentcmd-1])/16); - sentcmd++; - //if(!strcmp(cmds[sentcmd-1], "END")) - // sentcmd = 999; - break; - } - } - if (dbg) printf("continuing after burst\n"); - break; - } - return 1; -} - -uchar -revent(uchar chan, uchar event) -{ - struct ack_msg ack; - int i; - - if (dbg) printf("revent %02x %02x\n", chan, event); - switch (event) { - case EVENT_TRANSFER_TX_COMPLETED: - if (dbg) printf("Transfer complete %02x\n", ebuf[1]); - break; - case INVALID_MESSAGE: - printf("Invalid message %02x\n", ebuf[1]); - break; - case RESPONSE_NO_ERROR: - switch (ebuf[1]) { - case MESG_ASSIGN_CHANNEL_ID: - ANT_AssignChannelEventFunction(chan, chevent, cbuf); - break; - case MESG_OPEN_CHANNEL_ID: - printf("channel open, waiting for broadcast\n"); - break; - default: - if (dbg) printf("Message %02x NO_ERROR\n", ebuf[1]); - break; - } - break; - case MESG_CHANNEL_ID_ID: - devid = ebuf[1]+ebuf[2]*256; - if (mydev == 0 || devid == mydev%65536) { - if (dbg) - printf("devid %08x myid %08x\n", devid, myid); - } else { - printf("Ignoring unknown device %08x, mydev %08x\n", devid, mydev); - devid = sentid = 0; // reset - } - break; - case MESG_NETWORK_KEY_ID: - case MESG_SEARCH_WAVEFORM_ID: - case MESG_OPEN_CHANNEL_ID: - printf("response event %02x code %02x\n", event, ebuf[2]); - for (i = 0; i < 8; i++) - fprintf(stderr, "%02x", ebuf[i]); - fprintf(stderr, "\n"); - break; - case MESG_CAPABILITIES_ID: - if (dbg) - printf("capabilities chans %d nets %d opt %02x adv %02x\n", - ebuf[0], ebuf[1], ebuf[2], ebuf[3]); - break; - case MESG_CHANNEL_STATUS_ID: - if (dbg) - printf("channel status %d\n", ebuf[1]); - break; - case EVENT_RX_FAIL: - // ignore this - break; - default: - printf("Unhandled response event %02x\n", event); - break; - } - return 1; -} - -main(int ac, char *av[]) -{ - int devnum = 0; - int chan = 0; - int net = 0; - int chtype = 0; // wildcard - int devno = 0; // wildcard - int devtype = 0; // wildcard - int manid = 0; // wildcard - int freq = 0x32; // garmin specific radio frequency - int srchto = 255; // max timeout - int waveform = 0x0053; // aids search somehow - int c; - extern char *optarg; - extern int optind, opterr, optopt; - - // default auth file // - if (getenv("HOME")) { - authfile = malloc(strlen(getenv("HOME"))+strlen("/.gant")+1); - if (authfile) - sprintf(authfile, "%s/.gant", getenv("HOME")); - } - progname = av[0]; - while ((c = getopt(ac, av, "a:o:d:i:m:PpvDrnzf:")) != -1) { - switch(c) { - case 'a': - authfile = optarg; - break; - case 'f': - fname = optarg; - break; - case 'o': - fn = optarg; - break; - case 'd': - devnum = atoi(optarg); - break; - case 'i': - myid = atoi(optarg); - break; - case 'm': - mydev = atoi(optarg); - break; - case 'p': - passive = 1; - semipassive = 0; - break; - case 'P': - passive = 1; - break; - case 'v': - verbose = 1; - break; - case 'D': - dbg = 1; - break; - case 'r': - reset = 1; - break; - case 'n': - nowriteauth = 1; - break; - case 'z': - nopairing = 1; - break; - default: - fprintf(stderr, "unknown option %s\n", optarg); - usage(); - } - } - - ac -= optind; - av += optind; - - if ((!passive && !authfile) || ac) - usage(); - - if (!ANT_Init(devnum, 0)) { // should be 115200 but doesn't fit into a short - fprintf(stderr, "open dev %d failed\n", devnum); - exit(1); - } - ANT_ResetSystem(); - ANT_AssignResponseFunction(revent, ebuf); - ANT_RequestMessage(chan, MESG_CHANNEL_STATUS_ID); //informative - ANT_SetNetworkKeya(net, ANTSPT_KEY); - ANT_AssignChannel(chan, chtype, net); - // Wali: changed order of the following seq. according windows - ANT_SetChannelPeriod(chan, period); - ANT_SetChannelSearchTimeout(chan, srchto); - ANT_RequestMessage(chan, MESG_CAPABILITIES_ID); //informative - ANT_SetChannelRFFreq(chan, freq); - ANT_SetSearchWaveform(chan, waveform); - ANT_SetChannelId(chan, devno, devtype, manid); - ANT_OpenChannel(chan); - ANT_RequestMessage(chan, MESG_CHANNEL_STATUS_ID); //informative - - // everything handled in event functions - for(;;) - sleep(10); -} diff --git a/gant.c.orig b/gant.c.orig deleted file mode 100644 index 89a87c7..0000000 --- a/gant.c.orig +++ /dev/null @@ -1,1182 +0,0 @@ -// copyright 2008-2009 paul@ant.sbrk.co.uk. released under GPLv3 -// copyright 2009-2009 Wali -// vers 0.6t -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include - -#include "antdefs.h" - -char *releasetime = "Jan 21 2008, 12:00:00"; -uint majorrelease = 0; -uint minorrelease = 6; - -double round(double); - -int gottype; -int sentauth; -int gotwatchid; -int nopairing; -int nowriteauth; -int reset; -int dbg = 0; -int seenphase0 = 0; -int lastphase; -int sentack2; -int newfreq = 0; -int period = 0x1000; // garmin specific broadcast period -int donebind = 0; -int sentgetv; -char *fname = "garmin"; - -static char ANTSPT_KEY[] = "A8A423B9F55E63C1"; // ANT+Sport key - -static uchar ebuf[MESG_DATA_SIZE]; // response event data gets stored here -static uchar cbuf[MESG_DATA_SIZE]; // channel event data gets stored here - -int passive; -int semipassive; -int verbose; - -int downloadfinished = 0; -int downloadstarted = 0; -int sentid = 0; - -uint mydev = 0; -uint peerdev; -uint myid; -uint devid; -uint myauth1; -uint myauth2; -char authdata[32]; -uint pairing; -uint isa50; -uint isa405; -uint waitauth; -int nphase0; -char modelname[256]; -ushort part = 0; -ushort ver = 0; -uint unitid = 0; - - -//char *getversion = "440dffff00000000fe00000000000000"; -//char *getgpsver = "440dffff0000000006000200ff000000"; -char *acks[] = { - "fe00000000000000", // get version - 255, 248, 253 - "0e02000000000000", // device short name (fr405a) - 525 -// "1c00020000000000", // no data - "0a0002000e000000", // unit id - 38 - "0a00020002000000", // send position - "0a00020005000000", // send time - "0a000200ad020000", // 4 byte something? 0x10270000 = 10000 dec - 1523 - "0a000200c6010000", // 3 x 4 ints? - 994 - "0a00020035020000", // guessing this is # trackpoints per run - 1066 - "0a00020097000000", // load of software versions - 247 - "0a000200c2010000", // download runs - 27 (#runs), 990?, 12? - "0a00020075000000", // download laps - 27 (#laps), 149 laps, 12? - "0a00020006000000", // download trackpoints - 1510/99(run marker), ..1510,12 - "0a000200ac020000", - "" -}; -int sentcmd; - -uchar clientid[3][8]; - -int authfd = -1; -char *authfile; -int outfd; // output file -char *fn = "default_output_file"; -char *progname; - -#define BSIZE 8*100 -uchar *burstbuf = 0; -uchar *blast = 0; -int blsize = 0; -int bused = 0; -int lseq = -1; - -/* round a float as garmin does it! */ -/* shoot me for writing this! */ -char * -ground(double d) -{ - int neg = 0; - static char res[30]; - ulong ival; - ulong l; /* hope it doesn't overflow */ - - if (d < 0) { - neg = 1; - d = -d; - } - ival = floor(d); - d -= ival; - l = floor(d*100000000); - if (l % 10 >= 5) - l = l/10+1; - else - l = l/10; - sprintf(res,"%s%ld.%07ld", neg?"-":"", ival, l); - return res; -} - -char * -timestamp(void) -{ - struct timeval tv; - static char time[50]; - struct tm *tmp; - - gettimeofday(&tv, 0); - tmp = gmtime(&tv.tv_sec); - - sprintf(time, "%02d:%02d:%02d.%02d", - tmp->tm_hour, tmp->tm_min, tmp->tm_sec, (int)tv.tv_usec/10000); - return time; -} - -uint -randno(void) -{ - uint r; - - int fd = open("/dev/urandom", O_RDONLY); - if (fd > 0) { - read(fd, &r, sizeof r); - close(fd); - } - return r; -} - -void -print_tcx_header(FILE *tcxfile) -{ - fprintf(tcxfile, "\n"); - fprintf(tcxfile, "\n\n"); - fprintf(tcxfile, " \n"); - return; -} - -void -print_tcx_footer(FILE *tcxfile) -{ - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %s\n", modelname); - fprintf(tcxfile, " %u\n", unitid); - fprintf(tcxfile, " %u\n", part); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %u\n", ver/100); - fprintf(tcxfile, " %u\n", ver - ver/100*100); - fprintf(tcxfile, " 0\n"); - fprintf(tcxfile, " 0\n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n\n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " Garmin ANT for Linux\n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %u\n", majorrelease); - fprintf(tcxfile, " %u\n", minorrelease); - fprintf(tcxfile, " 0\n"); - fprintf(tcxfile, " 0\n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " Release\n"); - fprintf(tcxfile, " \n", releasetime); - fprintf(tcxfile, " make\n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " EN\n"); - fprintf(tcxfile, " 006-A0XXX-00\n"); - fprintf(tcxfile, " \n\n"); - fprintf(tcxfile, "\n"); - return; -} - - -#pragma pack(1) -struct ack_msg { - uchar code; - uchar atype; - uchar c1; - uchar c2; - uint id; -}; - -struct auth_msg { - uchar code; - uchar atype; - uchar phase; - uchar u1; - uint id; - uint auth1; - uint auth2; - uint fill1; - uint fill2; -}; - -struct pair_msg { - uchar code; - uchar atype; - uchar phase; - uchar u1; - uint id; - char devname[16]; -}; - -#pragma pack() -#define ACKSIZE 8 // above structure must be this size -#define AUTHSIZE 24 // ditto -#define PAIRSIZE 16 -#define MAXLAPS 256 // max of saving laps data before output with trackpoint data -#define MAXTRACK 256 // max number of tracks to be saved per download - -decode(ushort bloblen, ushort pkttype, ushort pktlen, int dsize, uchar *data) -{ - int i; - int j; - int hr; - int hr_av; - int hr_max; - int cal; - float tsec; - float max_speed; - int cad; - int u1, u2; - int doff = 20; - char model[256]; - char gpsver[256]; - char devname[256]; - float alt; - float dist; - uint tv; - uint tv_previous = 0; - time_t ttv; - char tbuf[100]; - struct tm *tmp; - double lat, lon; - uint nruns; - uint tv_lap; - static uchar lapbuf[MAXLAPS][48]; - static ushort lap = 0; - static ushort lastlap = 0; - static ushort track = 0; - static short previoustrack_id = -1; - static short track_id = -1; - static short firsttrack_id = -1; - static short firstlap_id = -1; - static ushort firstlap_id_track[MAXTRACK]; - static uchar sporttyp_track[MAXTRACK]; - static FILE *tcxfile = NULL; - static ushort track_pause = 0; - - - printf("decode %d %d %d %d\n", bloblen, pkttype, pktlen, dsize); - switch (pkttype) { - case 255: - memset(model, 0, sizeof model); - memcpy(model, data+doff+4, dsize-4); - part=data[doff]+data[doff+1]*256; - ver=data[doff+2]+data[doff+3]*256; - printf("%d Part#: %d ver: %d Name: %s\n", pkttype, - part, ver, model); - break; - case 248: - memset(gpsver, 0, sizeof gpsver); - memcpy(gpsver, data+doff, dsize); - printf("%d GPSver: %s\n", pkttype, - gpsver); - break; - case 253: - printf("%d Unknown\n", pkttype); - for (i = 0; i < pktlen; i += 3) - printf("%d.%d.%d\n", data[doff+i], data[doff+i+1], data[doff+i+2]); - break; - case 525: - memset(devname, 0, sizeof devname); - memcpy(devname, data+doff, dsize); - printf("%d Devname %s\n", pkttype, devname); - break; - case 12: - printf("%d xfer complete", pkttype); - for (i = 0; i < pktlen; i += 2) - printf(" %u", data[doff+i] + data[doff+i+1]*256); - printf("\n"); - switch (data[doff] + data[doff+1]*256) { - case 6: - // last file completed, add footer and close file - print_tcx_footer(tcxfile); - fclose(tcxfile); - break; - case 117: - break; - case 450: - break; - default: - break; - } - break; - case 38: - unitid = data[doff] + data[doff+1]*256 + - data[doff+2]*256*256 + data[doff+3]*256*256*256; - printf("%d unitid %u\n", pkttype, unitid); - break; - case 27: - nruns = data[doff] + data[doff+1] * 256; - printf("%d nruns %u\n", pkttype, nruns); - break; - case 1523: - case 994: - case 1066: - printf("%d ints?", pkttype); - for (i = 0; i < pktlen; i += 4) - printf(" %u", data[doff+i] + data[doff+i+1]*256 + - data[doff+i+2]*256*256 + data[doff+i+3]*256*256*256); - printf("\n"); - break; - case 14: - printf("%d time: ", pkttype); - printf("%02u-%02u-%u %02u:%02u:%02u\n", data[doff], data[doff+1], data[doff+2] + data[doff+3]*256, - data[doff+4], data[doff+6], data[doff+7]); - break; - case 17: - printf("%d position ? ", pkttype); - for (i = 0; i < pktlen; i += 4) - printf(" %u", data[doff+i] + data[doff+i+1]*256 + - data[doff+i+2]*256*256 + data[doff+i+3]*256*256*256); - printf("\n"); - break; - case 99: - printf("%d trackindex %u\n", pkttype, data[doff] + data[doff+1]*256); - printf("%d shorts?", pkttype); - for (i = 0; i < pktlen; i += 2) - printf(" %u", data[doff+i] + data[doff+i+1]*256); - printf("\n"); - track_id = data[doff] + data[doff+1]*256; - break; - case 990: - printf("%d track %u lap %u-%u sport %u\n", pkttype, - data[doff] + data[doff+1]*256, data[doff+2] + data[doff+3]*256, - data[doff+4] + data[doff+5]*256, data[doff+6]); - printf("%d shorts?", pkttype); - for (i = 0; i < pktlen; i += 2) - printf(" %u", data[doff+i] + data[doff+i+1]*256); - printf("\n"); - if (firstlap_id == -1) firstlap_id = data[doff+2] + data[doff+3]*256; - if (firsttrack_id == -1) firsttrack_id = data[doff] + data[doff+1]*256; - track = (data[doff] + data[doff+1]*256) - firsttrack_id; - if (track < MAXTRACK) { - firstlap_id_track[track] = data[doff+2] + data[doff+3]*256; - sporttyp_track[track] = data[doff+6]; - } else { - printf("Error: track and lap data temporary array out of range %u!\n", track); - } - break; - case 1510: - printf("%d waypoints", pkttype); - for (i = 0; i < 4 && i < pktlen; i += 4) - printf(" %u", data[doff+i] + data[doff+i+1]*256 + - data[doff+i+2]*256*256 + data[doff+i+3]*256*256*256); - printf("\n"); - // if trackpoints are split into more than one message 1510, do not add xml head again - if (previoustrack_id != track_id) { - // close previous file if it is not the first track to be downloaded - if (previoustrack_id > -1) { - // add xml footer and close file, the next file will be open further down - print_tcx_footer(tcxfile); - fclose(tcxfile); - } - // use first lap starttime as filename - lap = firstlap_id_track[track_id-firsttrack_id] - firstlap_id; - if (dbg) printf("lap %u track_id %u firsttrack_id %u firstlap_id %u\n", lap, track_id, firsttrack_id, firstlap_id); - tv_lap = lapbuf[lap][4] + lapbuf[lap][5]*256 + - lapbuf[lap][6]*256*256 + lapbuf[lap][7]*256*256*256; - ttv = tv_lap + 631065600; // garmin epoch offset - strftime(tbuf, sizeof tbuf, "%Y.%m.%d %H%M%S.TCX", localtime(&ttv)); - // open file and start with header of xml file - tcxfile = fopen(tbuf, "wt"); - print_tcx_header(tcxfile); - } - for (i = 4; i < pktlen; i += 24) { - tv = (data[doff+i+8] + data[doff+i+9]*256 + - data[doff+i+10]*256*256 + data[doff+i+11]*256*256*256); - tv_lap = lapbuf[lap][4] + lapbuf[lap][5]*256 + - lapbuf[lap][6]*256*256 + lapbuf[lap][7]*256*256*256; - if ((tv > tv_lap || (tv == tv_lap && lap == (firstlap_id_track[track_id-firsttrack_id] - firstlap_id))) && lap <= lastlap) { - ttv = tv_lap + 631065600; // garmin epoch offset - strftime(tbuf, sizeof tbuf, "%Y-%m-%dT%H:%M:%SZ", gmtime(&ttv)); - tsec = (lapbuf[lap][8] + lapbuf[lap][9]*256 + - lapbuf[lap][10]*256*256 + lapbuf[lap][11]*256*256*256); - memcpy((void *)&dist, &lapbuf[lap][12], 4); - memcpy((void *)&max_speed, &lapbuf[lap][16], 4); - cal = lapbuf[lap][36] + lapbuf[lap][37]*256; - hr_av = lapbuf[lap][38]; - hr_max = lapbuf[lap][39]; - cad = lapbuf[lap][41]; - if (lap == firstlap_id_track[track_id-firsttrack_id] - firstlap_id) { - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %s\n", tbuf); - } else { - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - } - fprintf(tcxfile, " \n", tbuf); - fprintf(tcxfile, " %s\n", ground(tsec/100)); - fprintf(tcxfile, " %s\n", ground(dist)); - fprintf(tcxfile, " %s\n", ground(max_speed)); - fprintf(tcxfile, " %d\n", cal); - if (hr_av > 0) { - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %d\n", hr_av); - fprintf(tcxfile, " \n"); - } - if (hr_max > 0) { - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %d\n", hr_max); - fprintf(tcxfile, " \n"); - } - fprintf(tcxfile, " "); - switch (lapbuf[lap][40]) { - case 0: fprintf(tcxfile, "Active"); break; - case 1: fprintf(tcxfile, "Rest"); break; - default: fprintf(tcxfile, "unknown value: %d", lapbuf[lap][40]); - } - fprintf(tcxfile, "\n"); - if (cad != 255) { - if (sporttyp_track[track_id-firsttrack_id] == 0) { - fprintf(tcxfile, " %d\n", cad); - } else { - fprintf(tcxfile, " %d\n", cad); - } - } - fprintf(tcxfile, " "); - switch(lapbuf[lap][42]) { - case 4: fprintf(tcxfile, "Heartrate"); break; - case 3: fprintf(tcxfile, "Time"); break; - case 2: fprintf(tcxfile, "Location"); break; - case 1: fprintf(tcxfile, "Distance"); break; - case 0: fprintf(tcxfile, "Manual"); break; - default: fprintf(tcxfile, "unknown value: %d", lapbuf[lap][42]); - } - fprintf(tcxfile, "\n"); - fprintf(tcxfile, " \n"); - lap++; - track_pause = 0; - // if the previous trackpoint has same second as lap time display the trackpoint again - if (dbg) printf("i %u tv %d tv_lap %d tv_previous %d\n", i, tv, tv_lap, tv_previous); - if (tv_previous == tv_lap) { - i -= 24; - tv = tv_previous; - } - } // end of if (tv >= tv_lap && lap <= lastlap) - if (track_pause) { - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - track_pause = 0; - if (dbg) printf("track pause (stop and go)\n"); - } - ttv = tv+631065600; // garmin epoch offset - tmp = gmtime(&ttv); - strftime(tbuf, sizeof tbuf, "%Y-%m-%dT%H:%M:%SZ", tmp); // format for printing - memcpy((void *)&alt, data+doff+i+12, 4); - memcpy((void *)&dist, data+doff+i+16, 4); - lat = (data[doff+i] + data[doff+i+1]*256 + - data[doff+i+2]*256*256 + data[doff+i+3]*256*256*256)*180.0/0x80000000; - lon = (data[doff+i+4] + data[doff+i+5]*256 + - data[doff+i+6]*256*256 + data[doff+i+7]*256*256*256)*180.0/0x80000000; - hr = data[doff+i+20]; - cad = data[doff+i+21]; - u1 = data[doff+i+22]; - u2 = data[doff+i+23]; - if (dbg) printf("lat %.10g lon %.10g hr %d cad %d u1 %d u2 %d tv %d %s alt %f dist %f %02x %02x%02x%02x%02x\n", lat, lon, - hr, cad, u1, u2, tv, tbuf, alt, dist, data[doff+i+3], data[doff+i+16], data[doff+i+17], data[doff+i+18], data[doff+i+19]); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n",tbuf); - if (lat < 90) { - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %s\n", - ground(lat)); - fprintf(tcxfile, " %s\n", - ground(lon)); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %s\n", ground(alt)); - } - // last trackpoint has utopic distance, 40000km should be enough, hack? - if (dist < (float)40000000) { - fprintf(tcxfile, " %s\n", ground(dist)); - } - if (hr > 0) { - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %d\n", hr); - fprintf(tcxfile, " \n"); - } - if (u1 > 0 && cad != 255) { - fprintf(tcxfile, " %d\n", cad); - } - if (dist < (float)40000000) { - fprintf(tcxfile, " %s\n", u1 ? "Present" : "Absent"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " \n"); - fprintf(tcxfile, " %d\n", cad); - fprintf(tcxfile, " \n"); - } else { - fprintf(tcxfile, "/>\n"); - } - fprintf(tcxfile, " \n"); - } else { - // maybe if we recieve utopic position and distance this tells pause in the run (stop and go) - if (track_pause == 0) track_pause = 1; - else track_pause = 0; - } - fprintf(tcxfile, " \n"); - tv_previous = tv; - } // end of for (i = 4; i < pktlen; i += 24) - previoustrack_id = track_id; - break; - case 149: - printf("%d Lap data id: %u %u\n", pkttype, - data[doff] + data[doff+1]*256, data[doff+2] + data[doff+3]*256); - if (lap < MAXLAPS) { - memcpy((void *)&lapbuf[lap][0], data+doff, 48); - lastlap = lap; - lap++; - } - break; - case 247: - memset(modelname, 0, sizeof modelname); - memcpy(modelname, data+doff+88, dsize-88); - printf("%d Device name %s\n", pkttype, modelname); - break; - default: - printf("don't know how to decode packet type %d\n", pkttype); - for (i = doff; i < dsize && i < doff+pktlen; i++) - printf("%02x", data[i]); - printf("\n"); - for (i = doff; i < dsize && i < doff+pktlen; i++) - if (isprint(data[i])) - printf("%c", data[i]); - else - printf("."); - printf("\n"); - } -} - -void -usage(void) -{ - fprintf(stderr, "Usage: %s -a authfile\n" - "[ -o outfile ]\n" - "[ -d devno ]\n" - "[ -i id ]\n" - "[ -m mydev ]\n" - "[ -p ]\n", - progname - ); - exit(1); -} - -uchar -chevent(uchar chan, uchar event) -{ - uchar seq; - uchar last; - uchar status; - uchar phase; - uint newdata; - struct ack_msg ack; - struct auth_msg auth; - struct pair_msg pair; - uint id; - int i; - uint cid; - if (dbg) printf("chevent %02x %02x\n", chan, event); - - if (event == EVENT_RX_BROADCAST) { - status = cbuf[1] & 0xd7; - newdata = cbuf[1] & 0x20; - phase = cbuf[2]; - } - cid = cbuf[4]+cbuf[5]*256+cbuf[6]*256*256+cbuf[7]*256*256*256; - memcpy((void *)&id, cbuf+4, 4); - - if (dbg) - fprintf(stderr, "cid %08x myid %08x\n", cid, myid); - if (dbg && event != EVENT_RX_BURST_PACKET) { - fprintf(stderr, "chan %d event %02x channel open: ", chan, event); - for (i = 0; i < 8; i++) - fprintf(stderr, "%02x", cbuf[i]); - fprintf(stderr, "\n"); - } - - switch (event) { - case EVENT_RX_BROADCAST: - lastphase = phase; // store the last phase we see the watch broadcast - if (dbg) printf("lastphase %d\n", lastphase); - if (!pairing && !nopairing) - pairing = cbuf[1] & 8; - if (!gottype) { - gottype = 1; - isa50 = cbuf[1] & 4; - isa405 = cbuf[1] & 1; - if ((isa50 && isa405) || (!isa50 && !isa405)) { - fprintf(stderr, "50 %d and 405 %d\n", isa50, isa405); - exit(1); - } - } - if (verbose) { - switch (phase) { - case 0: - fprintf(stderr, "%s BC0 %02x %d %d %d PID %d %d %d %c%c\n", - timestamp(), - cbuf[0], cbuf[1] & 0xd7, cbuf[2], cbuf[3], - cbuf[4]+cbuf[5]*256, cbuf[6], cbuf[7], - (cbuf[1] & 0x20) ? 'N' : ' ', (cbuf[1] & 0x08) ? 'P' : ' ' - ); - break; - case 1: - fprintf(stderr, "%s BC1 %02x %d %d %d CID %08x %c%c\n", - timestamp(), - cbuf[0], cbuf[1] & 0xd7, cbuf[2], cbuf[3], cid, - (cbuf[1] & 0x20) ? 'N' : ' ', (cbuf[1] & 0x08) ? 'P' : ' ' - ); - break; - fprintf(stderr, "%s BCX %02x %d %d %d PID %d %d %d %c%c\n", - timestamp(), - cbuf[0], cbuf[1] & 0xd7, cbuf[2], cbuf[3], - cbuf[4]+cbuf[5]*256, cbuf[6], cbuf[7], - (cbuf[1] & 0x20) ? 'N' : ' ', (cbuf[1] & 0x08) ? 'P' : ' ' - ); - default: - break; - } - } - - if (dbg) - printf("watch status %02x stage %d id %08x\n", status, phase, id); - - if (!sentid) { - sentid = 1; - ANT_RequestMessage(chan, MESG_CHANNEL_ID_ID); /* request sender id */ - } - - // if we don't see a phase 0 message first, reset the watch - if (reset || (phase != 0 && !seenphase0)) { - fprintf(stderr, "resetting\n"); - ack.code = 0x44; ack.atype = 3; ack.c1 = 0x00; ack.c2 = 0x00; ack.id = 0; - ANT_SendAcknowledgedData(chan, (void *)&ack); // tell garmin we're finished - sleep(1); - exit(1); - } - switch (phase) { - case 0: - seenphase0 = 1; - nphase0++; - if (nphase0 % 10 == 0) - donebind = 0; - if (newfreq) { - // switch to new frequency - ANT_SetChannelPeriod(chan, period); - ANT_SetChannelSearchTimeout(chan, 3); - ANT_SetChannelRFFreq(chan, newfreq); - newfreq = 0; - } - // phase 0 seen after reset at end of download - if (downloadfinished) { - fprintf(stderr, "finished\n"); - exit(0); - } - // generate a random id if pairing and user didn't specify one - if (pairing && !myid) { - myid = randno(); - fprintf(stderr, "pairing, using id %08x\n", myid); - } - // need id codes from auth file if not pairing - // TODO: handle multiple watches - // BUG: myauth1 should be allowed to be 0 - if (!pairing && !myauth1) { - int nr; - printf("reading auth data from %s\n", authfile); - authfd = open(authfile, O_RDONLY); - if (authfd < 0) { - perror(authfile); - fprintf(stderr, "No auth data. Need to pair first\n"); - exit(1); - } - nr = read(authfd, authdata, 32); - close(authfd); - if (nr != 32 && nr != 24) { - fprintf(stderr, "bad auth file len %d != 32 or 24\n", nr); - exit(1); - } - // BUG: auth file not portable - memcpy((void *)&myauth1, authdata+16, 4); - memcpy((void *)&myauth2, authdata+20, 4); - memcpy((void *)&mydev, authdata+12, 4); - memcpy((void *)&myid, authdata+4, 4); - if (dbg) - fprintf(stderr, "dev %08x auth %08x %08x id %08x\n", - mydev, myauth1, myauth2, myid); - } - // bind to watch - if (!donebind && devid) { - donebind = 1; - if (isa405) - newfreq = 0x32; - ack.code = 0x44; ack.atype = 2; ack.c1 = isa50 ? 0x32 : newfreq; ack.c2 = 0x04; - ack.id = myid; - ANT_SendAcknowledgedData(chan, (void *)&ack); // bind - } else { - if (dbg) printf("donebind %d devid %x\n", donebind, devid); - } - break; - case 1: - if (dbg) printf("case 1 %x\n", peerdev); - if (peerdev) { - if (dbg) printf("case 1 peerdev\n"); - // if watch has sent id - if (mydev != 0 && peerdev != mydev) { - fprintf(stderr, "Don't know this device %08x != %08x\n", peerdev, mydev); - } else if (!sentauth && !waitauth) { - if (dbg) printf("case 1 diffdev\n"); - assert(sizeof auth == AUTHSIZE); - auth.code = 0x44; auth.atype = 4; auth.phase = 3; auth.u1 = 8; - auth.id = myid; auth.auth1 = myauth1; auth.auth2 = myauth2; - auth.fill1 = auth.fill2 = 0; - sentauth = 1; - ANT_SendBurstTransfer(chan, (void *)&auth, (sizeof auth)/8); // send our auth data - } - } - if (dbg) printf("case 1 cid %x myid %x\n", cid, myid); - if (!sentack2 && cid == myid && !waitauth) { - sentack2 = 1; - if (dbg) printf("sending ack2\n"); - // if it did bind to me before someone else - ack.code = 0x44; ack.atype = 4; ack.c1 = 0x01; ack.c2 = 0x00; - ack.id = myid; - ANT_SendAcknowledgedData(chan, (void *)&ack); // request id - } - break; - case 2: - // successfully authenticated - if (!downloadstarted) { - downloadstarted = 1; - if (dbg) printf("starting download\n"); - ack.code = 0x44; ack.atype = 6; ack.c1 = 0x01; ack.c2 = 0x00; ack.id = 0; - //ANT_SendAcknowledgedData(chan, (void *)&ack); // tell garmin to start upload - } - if (downloadfinished) { - if (dbg) printf("finished download\n"); - ack.code = 0x44; ack.atype = 3; ack.c1 = 0x00; ack.c2 = 0x00; ack.id = 0; - if (!passive) ANT_SendAcknowledgedData(chan, (void *)&ack); // tell garmin we're finished - } - break; - case 3: - if (pairing) { - // waiting for the user to pair - printf("Please press \"View\" on watch to confirm pairing\n"); - waitauth = 2; // next burst data is auth data - } else { - if (dbg) printf("not sure why in phase 3\n"); - if (!sentgetv) { - sentgetv = 1; - //ANT_SendBurstTransferA(chan, getversion, strlen(getversion)/16); - } - } - break; - default: - if (dbg) fprintf(stderr, "Unknown phase %d\n", phase); - break; - } - break; - case EVENT_RX_BURST_PACKET: - // now handled in coalesced burst below - if (dbg) printf("burst\n"); - break; - case EVENT_RX_FAKE_BURST: - if (dbg) printf("rxfake burst pairing %d blast %ld waitauth %d\n", - pairing, (long)blast, waitauth); - blsize = *(int *)(cbuf+4); - memcpy(&blast, cbuf+8, 4); - if (dbg) { - printf("fake burst %d %lx ", blsize, (long)blast); - for (i = 0; i < blsize && i < 64; i++) - printf("%02x", blast[i]); - printf("\n"); - for (i = 0; i < blsize; i++) - if (isprint(blast[i])) - printf("%c", blast[i]); - else - printf("."); - printf("\n"); - } - if (sentauth) { - static int nacksent = 0; - char *ackdata; - static uchar ackpkt[100]; - // ack the last packet - ushort bloblen = blast[14]+256*blast[15]; - ushort pkttype = blast[16]+256*blast[17]; - ushort pktlen = blast[18]+256*blast[19]; - if (bloblen == 0) { - if (dbg) printf("bloblen %d, get next data\n", bloblen); - // request next set of data - ackdata = acks[nacksent++]; - if (!strcmp(ackdata, "")) { // finished - printf("acks finished, resetting\n"); - ack.code = 0x44; ack.atype = 3; ack.c1 = 0x00; - ack.c2 = 0x00; ack.id = 0; - ANT_SendAcknowledgedData(chan, (void *)&ack); // go to idle - sleep(1); - exit(1); - } - if (dbg) printf("got type 0, sending ack %s\n", ackdata); - sprintf(ackpkt, "440dffff00000000%s", ackdata); - } else if (bloblen == 65535) { - // repeat last ack - if (dbg) printf("repeating ack %s\n", ackpkt); - ANT_SendBurstTransferA(chan, ackpkt, strlen(ackpkt)/16); - } else { - if (dbg) printf("non-0 bloblen %d\n", bloblen); - decode(bloblen, pkttype, pktlen, blsize, blast); - sprintf(ackpkt, "440dffff0000000006000200%02x%02x0000", pkttype%256, pkttype/256); - } - if (dbg) printf("received pkttype %d len %d\n", pkttype, pktlen); - if (dbg) printf("acking %s\n", ackpkt); - ANT_SendBurstTransferA(chan, ackpkt, strlen(ackpkt)/16); - } else if (!nopairing && pairing && blast) { - memcpy(&peerdev, blast+12, 4); - if (dbg) - printf("watch id %08x waitauth %d\n", peerdev, waitauth); - if (mydev != 0 && peerdev != mydev) { - fprintf(stderr, "Don't know this device %08x != %08x\n", peerdev, mydev); - exit(1); - } - if (waitauth == 2) { - int nw; - // should be receiving auth data - if (nowriteauth) { - printf("Not overwriting auth data\n"); - exit(1); - } - printf("storing auth data in %s\n", authfile); - authfd = open(authfile, O_WRONLY|O_CREAT, 0644); - if (authfd < 0) { - perror(authfile); - exit(1); - } - nw = write(authfd, blast, blsize); - if (nw != blsize) { - fprintf(stderr, "auth write failed fd %d %d\n", authfd, nw); - perror("write"); - exit(1); - } - close(authfd); - //exit(1); - pairing = 0; - waitauth = 0; - reset = 1; - } - if (pairing && !waitauth) { - //assert(sizeof pair == PAIRSIZE); - pair.code = 0x44; pair.atype = 4; pair.phase = 2; pair.id = myid; - bzero(pair.devname, sizeof pair.devname); - //if (peerdev <= 9999999) // only allow 7 digits - //sprintf(pair.devname, "%u", peerdev); - strcpy(pair.devname, fname); - //else - // fprintf(stderr, "pair dev name too large %08x \"%d\"\n", peerdev, peerdev); - pair.u1 = strlen(pair.devname); - printf("sending pair data for dev %s\n", pair.devname); - waitauth = 1; - if (isa405 && pairing) { - // go straight to storing auth data - waitauth = 2; - } - ANT_SendBurstTransfer(chan, (void *)&pair, (sizeof pair)/8) ; // send pair data - } else { - if (dbg) printf("not pairing\n"); - } - } else if (!gotwatchid && (lastphase == 1)) { - static int once = 0; - gotwatchid = 1; - // garmin sending authentication/identification data - if (!once) { - int i; - once = 1; - if (dbg) - fprintf(stderr, "id data: "); - } - if (dbg) - for (i = 0; i < blsize; i++) - fprintf(stderr, "%02x", blast[i]); - if (dbg) - fprintf(stderr, "\n"); - memcpy(&peerdev, blast+12, 4); - if (dbg) - printf("watch id %08x\n", peerdev); - if (mydev != 0 && peerdev != mydev) { - fprintf(stderr, "Don't know this device %08x != %08x\n", peerdev, mydev); - exit(1); - } - } else if (lastphase == 2) { - int nw; - static int once = 0; - printf("once %d\n", once); - // garmin uploading in response to sendack3 - // in this state we're receiving the workout data - if (!once) { - printf("receiving\n"); - once = 1; - outfd = open(fn, O_WRONLY|O_CREAT, 0644); - if (outfd < 0) { - perror(fn); - exit(1); - } - } - if (last) { - nw = write(outfd, blast, blsize); - if (nw != blsize) { - fprintf(stderr, "data write failed fd %d %d\n", outfd, nw); - perror("write"); - exit(1); - } - close(outfd); - downloadfinished = 1; - } - } else if (0 && last) { - if (dbg) { - fprintf(stderr, "auth response: "); - for (i = 0; i < blsize; i++) - fprintf(stderr, "%02x", cbuf[i]); - fprintf(stderr, "\n"); - } - if (blast[10] == 2) { - fprintf(stderr, "authentication failed\n"); - exit(1); - } - } else if (last) { - fprintf(stderr, "data in state xx: "); - int i; - for (i = 0; i < blsize; i++) - fprintf(stderr, "%02x", blast[i]); - fprintf(stderr, "\n"); - sentcmd = 1000; - switch (sentcmd) { - case 1000: - break; - case 0: - sentcmd++; - //ANT_SendBurstTransferA(chan, getgpsver, strlen(getgpsver)/16); - break; - case 999: - printf("finished\n"); - exit(1); - default: - sleep(1); - sentcmd = 1; - //printf("sending command %d %s\n", sentcmd-1, cmds[sentcmd-1]); - //ANT_SendBurstTransferA(chan, cmds[sentcmd-1], - // strlen(cmds[sentcmd-1])/16); - sentcmd++; - //if(!strcmp(cmds[sentcmd-1], "END")) - // sentcmd = 999; - break; - } - } - if (dbg) printf("continuing after burst\n"); - break; - } - return 1; -} - -uchar -revent(uchar chan, uchar event) -{ - struct ack_msg ack; - int i; - - if (dbg) printf("revent %02x %02x\n", chan, event); - switch (event) { - case EVENT_TRANSFER_TX_COMPLETED: - if (dbg) printf("Transfer complete %02x\n", ebuf[1]); - break; - case INVALID_MESSAGE: - printf("Invalid message %02x\n", ebuf[1]); - break; - case RESPONSE_NO_ERROR: - switch (ebuf[1]) { - case MESG_ASSIGN_CHANNEL_ID: - ANT_AssignChannelEventFunction(chan, chevent, cbuf); - break; - case MESG_OPEN_CHANNEL_ID: - printf("channel open, waiting for broadcast\n"); - break; - default: - if (dbg) printf("Message %02x NO_ERROR\n", ebuf[1]); - break; - } - break; - case MESG_CHANNEL_ID_ID: - devid = ebuf[1]+ebuf[2]*256; - if (mydev == 0 || devid == mydev%65536) { - if (dbg) - printf("devid %08x myid %08x\n", devid, myid); - } else { - printf("Ignoring unknown device %08x, mydev %08x\n", devid, mydev); - devid = sentid = 0; // reset - } - break; - case MESG_NETWORK_KEY_ID: - case MESG_SEARCH_WAVEFORM_ID: - case MESG_OPEN_CHANNEL_ID: - printf("response event %02x code %02x\n", event, ebuf[2]); - for (i = 0; i < 8; i++) - fprintf(stderr, "%02x", ebuf[i]); - fprintf(stderr, "\n"); - break; - case MESG_CAPABILITIES_ID: - if (dbg) - printf("capabilities chans %d nets %d opt %02x adv %02x\n", - ebuf[0], ebuf[1], ebuf[2], ebuf[3]); - break; - case MESG_CHANNEL_STATUS_ID: - if (dbg) - printf("channel status %d\n", ebuf[1]); - break; - case EVENT_RX_FAIL: - // ignore this - break; - default: - printf("Unhandled response event %02x\n", event); - break; - } - return 1; -} - -main(int ac, char *av[]) -{ - int devnum = 0; - int chan = 0; - int net = 0; - int chtype = 0; // wildcard - int devno = 0; // wildcard - int devtype = 0; // wildcard - int manid = 0; // wildcard - int freq = 0x32; // garmin specific radio frequency - int srchto = 255; // max timeout - int waveform = 0x0053; // aids search somehow - int c; - extern char *optarg; - extern int optind, opterr, optopt; - - // default auth file // - if (getenv("HOME")) { - authfile = malloc(strlen(getenv("HOME"))+strlen("/.gant")+1); - if (authfile) - sprintf(authfile, "%s/.gant", getenv("HOME")); - } - progname = av[0]; - while ((c = getopt(ac, av, "a:o:d:i:m:PpvDrnzf:")) != -1) { - switch(c) { - case 'a': - authfile = optarg; - break; - case 'f': - fname = optarg; - break; - case 'o': - fn = optarg; - break; - case 'd': - devnum = atoi(optarg); - break; - case 'i': - myid = atoi(optarg); - break; - case 'm': - mydev = atoi(optarg); - break; - case 'p': - passive = 1; - semipassive = 0; - break; - case 'P': - passive = 1; - break; - case 'v': - verbose = 1; - break; - case 'D': - dbg = 1; - break; - case 'r': - reset = 1; - break; - case 'n': - nowriteauth = 1; - break; - case 'z': - nopairing = 1; - break; - default: - fprintf(stderr, "unknown option %s\n", optarg); - usage(); - } - } - - ac -= optind; - av += optind; - - if ((!passive && !authfile) || ac) - usage(); - - if (!ANT_Init(devnum, 0)) { // should be 115200 but doesn't fit into a short - fprintf(stderr, "open dev %d failed\n", devnum); - exit(1); - } - ANT_ResetSystem(); - ANT_AssignResponseFunction(revent, ebuf); - ANT_RequestMessage(chan, MESG_CHANNEL_STATUS_ID); //informative - ANT_SetNetworkKeya(net, ANTSPT_KEY); - ANT_AssignChannel(chan, chtype, net); - // Wali: changed order of the following seq. according windows - ANT_SetChannelPeriod(chan, period); - ANT_SetChannelSearchTimeout(chan, srchto); - ANT_RequestMessage(chan, MESG_CAPABILITIES_ID); //informative - ANT_SetChannelRFFreq(chan, freq); - ANT_SetSearchWaveform(chan, waveform); - ANT_SetChannelId(chan, devno, devtype, manid); - ANT_OpenChannel(chan); - ANT_RequestMessage(chan, MESG_CHANNEL_STATUS_ID); //informative - - // everything handled in event functions - for(;;) - sleep(10); -} -- 2.39.5