+++ /dev/null
-// copyright 2008 paul@ant.sbrk.co.uk. released under GPLv3
-// vers 0.6t
-#include <unistd.h>
-#include <sys/types.h>
-#include <sys/stat.h>
-#include <fcntl.h>
-#include <stdio.h>
-#include <string.h>
-#include <pthread.h>
-#include <termios.h>
-#include <stdlib.h>
-
-#define __declspec(X)
-
-#include "antdefs.h"
-//#include "antdefines.h"
-//#include "ANT_Interface.h"
-//#include "antmessage.h"
-//#include "anttypes.h"
-
-#define S(e) if (-1 == (e)) {perror(#e);exit(1);} else
-
-#define MAXMSG 30 // SYNC,LEN,MSG,data[9+],CHKSUM
-#define MAXCHAN 32
-#define BSIZE 8*10000
-
-#define uchar unsigned char
-
-#define hexval(c) ((c >= '0' && c <= '9') ? (c-'0') : ((c&0xdf)-'A'+10))
-
-static int fd = -1;
-static int dbg = 0;
-static pthread_t commthread;;
-static int commenabled = 1;
-
-static RESPONSE_FUNC rfn = 0;
-static uchar *rbufp;
-static CHANNEL_EVENT_FUNC cfn = 0;
-static uchar *cbufp;
-
-static uchar *blast;
-static int blsize;
-
-struct msg_queue {
- uchar msgid;
- uchar len;
-};
-
-// send message over serial port
-uchar
-msg_send(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;
- usleep(10*1000);
- if (4+i != (nw=write(fd, buf, 4+i))) {
- if (dbg) {
- perror("failed write");
- }
- }
- return 1;
-}
-
-// two argument send
-uchar
-msg_send2(uchar mesg, uchar data1, uchar data2)
-{
- uchar buf[2];
- buf[0] = data1;
- buf[1] = data2;
- return msg_send(mesg, buf, 2);
-}
-
-// three argument send
-uchar
-msg_send3(uchar mesg, uchar data1, uchar data2, uchar data3)
-{
- uchar buf[3];
- buf[0] = data1;
- buf[1] = data2;
- buf[2] = data3;
- return msg_send(mesg, buf, 3);
-}
-
-void *commfn(void* arg)
-{
- fd_set readfds, writefds, exceptfds;
- int ready;
- struct timeval to;
-
- for(;;) {
- FD_ZERO(&readfds);
- FD_ZERO(&writefds);
- FD_ZERO(&exceptfds);
- FD_SET(fd, &readfds);
- to.tv_sec = 1;
- to.tv_usec = 0;
- ready = select(fd+1, &readfds, &writefds, &exceptfds, &to);
- if (ready) {
- get_data(fd);
- }
- }
-}
-
-get_data(int fd)
-{
- static uchar buf[500];
- static int bufc = 0;
- int nr;
- int dlen;
- int i;
- int j;
- unsigned char chk = 0;
- uchar event;
- int found;
- int srch;
- int next;
-
- nr = read(fd, buf+bufc, 20);
- if (nr > 0)
- bufc += nr;
- else
- return;
- if (bufc > 30) {
- if (dbg)
- fprintf(stderr, "bufc %d\n", bufc);
- }
- if (bufc > 300) {
- fprintf(stderr, "buf too long %d\n", bufc);
- for (j = 0; j < bufc; j++)
- fprintf(stderr, "%02x", buf[j]);
- fprintf(stderr, "\n");
- exit(1);
- }
-
- // some data in buf
- // search for possible valid messages
- srch = 0;
- while (srch < bufc) {
- found = 0;
- //printf("srch %d bufc %d\n", srch, bufc);
- for (i = srch; i < bufc; i++) {
- if (buf[i] == MESG_TX_SYNC) {
- //fprintf(stderr, "bufc %d sync %d\n", bufc, i);
- if (i+1 < bufc && buf[i+1] >= 1 && buf[i+1] <= 13) {
- dlen = buf[i+1];
- if (i+3+dlen < bufc) {
- chk = 0;
- for (j = i; j <= i+3+dlen; j++)
- chk ^= buf[j];
- if (0 == chk) {
- found = 1; // got a valid message
- break;
- } else {
- fprintf(stderr, "bad chk %02x\n", chk);
- for (j = i; j <= i+3+dlen; j++)
- fprintf(stderr, "%02x", buf[j]);
- fprintf(stderr, "\n");
- }
- }
- }
- }
- }
- if (found) {
- next = j;
- //printf("next %d %02x\n", next, buf[j-1]);
- // got a valid message, see if any data needs to be discarded
- if (i > srch) {
- fprintf(stderr, "\nDiscarding: ");
- for (j = 0; j < i; j++)
- fprintf(stderr, "%02x", buf[j]);
- fprintf(stderr, "\n");
- }
-
- if (dbg) {
- fprintf(stderr, "data: ");
- for(j = i; j < i+dlen+4; j++) {
- fprintf(stderr, "%02x", buf[j]);
- }
- fprintf(stderr, "\n");
- }
- event = 0;
- switch (buf[i+2]) {
- case MESG_RESPONSE_EVENT_ID:
- //if (cfn) {
- // memcpy(cbufp, buf+i+4, dlen);
- // (*cfn)(buf[i+3], buf[i+5]);
- // else
- if (rfn) {
- memcpy(rbufp, buf+i+3, dlen);
- (*rfn)(buf[i+3], buf[i+5]);
- } else {
- if (dbg)
- fprintf(stderr, "no rfn or cfn\n");
- }
- break;
- case MESG_BROADCAST_DATA_ID:
- event = EVENT_RX_BROADCAST;
- break;
- case MESG_ACKNOWLEDGED_DATA_ID:
- event = EVENT_RX_ACKNOWLEDGED;
- break;
- case MESG_BURST_DATA_ID:
- event = EVENT_RX_BURST_PACKET;
- // coalesce these and generate a fake event on last packet
- // in case client wishes to ignore these events and capture the fake one
- {
- static uchar *burstbuf[MAXCHAN];
- static int bused[MAXCHAN];
- static int lseq[MAXCHAN];
- int k;
-
- uchar seq;
- uchar last;
- uchar chan = *(buf+i+3);
- if (dbg) {
- fprintf(stderr, "burst %02x ", chan);
- for (k = 0; k < 12; k++)
- fprintf(stderr, "%02x", buf[i+k]);
- fprintf(stderr, "\n");
- }
- seq = (chan & 0x60) >> 5;
- last = (chan & 0x80) >> 7;
- chan &= 0x1f;
- if (dbg) fprintf(stderr, "ch %x seq %d last %d\n", chan, seq, last);
- if (!burstbuf[chan]) {
- if (seq != 0)
- fprintf(stderr, "out of sequence ch# %d %d\n", chan, seq);
- else {
- burstbuf[chan] = malloc(BSIZE);
- bzero(burstbuf[chan], BSIZE);
- memcpy(burstbuf[chan], buf+i+4, 8);
- bused[chan] = 8;
- lseq[chan] = seq;
- if (dbg)
- fprintf(stderr, "init ch# %d %d\n", chan, lseq[chan]);
- }
- } else {
- if (lseq[chan]+1 != seq) {
- fprintf(stderr, "out of sequence ch# %d %d l %d\n", chan, seq, lseq[chan]);
- free(burstbuf[chan]);
- burstbuf[chan] = 0;
- if (seq == 0) {
- burstbuf[chan] = malloc(BSIZE);
- bzero(burstbuf[chan], BSIZE);
- memcpy(burstbuf[chan], buf+i+4, 8);
- bused[chan] = 8;
- lseq[chan] = seq;
- fprintf(stderr, "reinit ch# %d %d\n", chan, lseq[chan]);
- }
- } else {
- if ((bused[chan] % BSIZE) == 0) {
- burstbuf[chan] = realloc(burstbuf[chan], bused[chan]+BSIZE);
- bzero(burstbuf[chan]+bused[chan], BSIZE);
- }
- memcpy(burstbuf[chan]+bused[chan], buf+i+4, 8);
- bused[chan] += 8;
- if (dbg) fprintf(stderr, "seq0 %d lseq %d\n", seq, lseq[chan]);
- if (seq == 3)
- lseq[chan] = 0;
- else
- lseq[chan] = seq;
- if (dbg) fprintf(stderr, "seq1 %d lseq %d\n", seq, lseq[chan]);
- }
- }
- if (burstbuf[chan] && last) {
- blast = burstbuf[chan];
- blsize = bused[chan];
- if (dbg) fprintf(stderr, "BU %d %lx\n", blsize, (long)blast);
- if (dbg) {
- fprintf(stderr, "bused ch# %d %d\n", chan, bused[chan]);
- for (k = 0; k < bused[chan]; k++)
- fprintf(stderr, "%02x", burstbuf[chan][k]);
- fprintf(stderr, "\n");
- }
- bused[chan] = 0;
- burstbuf[chan] = 0;
- }
- }
- break;
- case MESG_EXT_BROADCAST_DATA_ID:
- event = EVENT_RX_EXT_BROADCAST;
- break;
- case MESG_EXT_ACKNOWLEDGED_DATA_ID:
- event = EVENT_RX_EXT_ACKNOWLEDGED;
- break;
- case MESG_EXT_BURST_DATA_ID:
- event = EVENT_RX_EXT_BURST_PACKET;
- break;
- default:
- if (rfn) {
- // should be this according to the docs, but doesn't fit
- // if (dlen > MESG_RESPONSE_EVENT_SIZE) {
- if (dlen > MESG_DATA_SIZE) {
- fprintf(stderr, "cresponse buffer too small %d > %d\n", dlen, MESG_DATA_SIZE);
- for (j = 0; j < dlen; j++)
- fprintf(stderr, "%02x", *(buf+i+3+j));
- fprintf(stderr, "\n");
- exit(1);
- }
- memcpy(rbufp, buf+i+3, dlen);
- (*rfn)(buf[i+3], buf[i+2]);
- } else {
- if (dbg)
- fprintf(stderr, "no rfn\n");
- }
- }
- if (event) {
- uchar chan = *(buf+3) & 0x1f;
- if (cfn) {
- if (dlen > MESG_DATA_SIZE) {
- fprintf(stderr, "rresponse buffer too small %d > %d\n",
- dlen, MESG_DATA_SIZE);
- for (j = 0; j < dlen+1; j++)
- fprintf(stderr, "%02x", *(buf+i+4+j));
- fprintf(stderr, "\n");
- exit(1);
- }
- memcpy(cbufp, buf+i+4, dlen);
- if (dbg) {
- fprintf(stderr, "xch0#%d %d %lx\n", chan, blsize, blast);
- for (j = 0; j < blsize; j++)
- fprintf(stderr, "%02x", *(blast+j));
- fprintf(stderr, "\n");
- }
- (*cfn)(chan, event);
- if (dbg) {
- fprintf(stderr, "xch1#%d %d %lx\n", chan, blsize, blast);
- for (j = 0; j < blsize; j++)
- fprintf(stderr, "%02x", *(blast+j));
- fprintf(stderr, "\n");
- }
- // FAKE BURST message
- if (event == EVENT_RX_BURST_PACKET && blast && blsize) {
- if (dbg) {
- fprintf(stderr, "Fake burst ch#%d %d %lx\n", chan, blsize, blast);
- for (j = 0; j < blsize; j++)
- fprintf(stderr, "%02x", *(blast+j));
- fprintf(stderr, "\n");
- }
- *(int *)(cbufp+4) = blsize;
- memcpy(cbufp+8, &blast, 4);
- (*cfn)(chan, EVENT_RX_FAKE_BURST);
- free(blast);
- blast = 0;
- blsize = 0;
- }
- } else
- if (dbg)
- fprintf(stderr, "no cfn\n");
- }
- srch = next;
- } else
- break;
- }
- if (next < bufc) {
- memmove(buf, buf+next, bufc-next);
- bufc -= next;
- } else
- bufc = 0;
-}
-
-uchar
-ANT_ResetSystem(void)
-{
- uchar filler = 0;
- return msg_send(MESG_SYSTEM_RESET_ID, &filler, 1);
-}
-
-uchar
-ANT_Cmd55(uchar chan)
-{
- return msg_send(0x55, &chan, 1);
-}
-
-uchar
-ANT_OpenRxScanMode(uchar chan)
-{
- return msg_send(MESG_OPEN_RX_SCAN_ID, &chan, 1);
-}
-
-uchar
-ANT_Initf(char *devname, ushort baud)
-{
- struct termios tp;
-
- fd = open(devname, O_RDWR);
- if (fd < 0) {
- perror(devname);
- return 0;
- }
-
- S(tcgetattr(fd, &tp));
- tp.c_iflag &=
- ~(IGNBRK|BRKINT|PARMRK|ISTRIP|INLCR|IGNCR|ICRNL|IXON|IXOFF|IXANY|INPCK|IUCLC);
- tp.c_oflag &= ~OPOST;
- tp.c_lflag &= ~(ECHO|ECHONL|ICANON|ISIG|IEXTEN|ECHOE);
- tp.c_cflag &= ~(CSIZE|PARENB);
- tp.c_cflag |= CS8 | CLOCAL | CREAD | CRTSCTS;
-
- S(cfsetispeed(&tp, B115200));
- S(cfsetospeed(&tp, B115200));
- tp.c_cc[VMIN] = 1;
- tp.c_cc[VTIME] = 0;
- S(tcsetattr(fd, TCSANOW, &tp));
-
- if (pthread_create(&commthread, 0, commfn, 0));
- return 1;
-}
-
-uchar
-ANT_Init(uchar devno, ushort baud)
-{
- char dev[40];
-
- sprintf(dev, "/dev/ttyUSB%d", devno);
- return ANT_Initf(dev, devno);
-}
-
-uchar
-ANT_RequestMessage(uchar chan, uchar mesg)
-{
- return msg_send2(MESG_REQUEST_ID, chan, mesg);
-}
-
-uchar
-ANT_SetNetworkKeya(uchar net, uchar *key)
-{
- uchar buf[9];
- int i;
-
- if (strlen(key) != 16) {
- fprintf(stderr, "Bad key length %s\n", key);
- return 0;
- }
- buf[0] = net;
- for (i = 0; i < 8; i++)
- buf[1+i] = hexval(key[i*2])*16+hexval(key[i*2+1]);
- return msg_send(MESG_NETWORK_KEY_ID, buf, 9);
-}
-
-uchar
-ANT_SetNetworkKey(uchar net, uchar *key)
-{
- uchar buf[9];
- int i;
-
- buf[0] = net;
- memcpy(buf+1, key, 8);
- return msg_send(MESG_NETWORK_KEY_ID, buf, 9);
-}
-
-uchar
-ANT_AssignChannel(uchar chan, uchar chtype, uchar net)
-{
- return msg_send3(MESG_ASSIGN_CHANNEL_ID, chan, chtype, net);
-}
-
-uchar
-ANT_UnAssignChannel(uchar chan)
-{
- return msg_send(MESG_UNASSIGN_CHANNEL_ID, &chan, 1);
-}
-
-uchar
-ANT_SetChannelId(uchar chan, ushort dev, uchar devtype, uchar manid)
-{
- uchar buf[5];
- buf[0] = chan;
- buf[1] = dev%256;
- buf[2] = dev/256;
- buf[3] = devtype;
- buf[4] = manid;
- return msg_send(MESG_CHANNEL_ID_ID, buf, 5);
-}
-
-uchar
-ANT_SetChannelRFFreq(uchar chan, uchar freq)
-{
- return msg_send2(MESG_CHANNEL_RADIO_FREQ_ID, chan, freq);
-}
-
-uchar
-ANT_SetChannelPeriod(uchar chan, ushort period)
-{
- uchar buf[3];
- buf[0] = chan;
- buf[1] = period%256;
- buf[2] = period/256;
- return msg_send(MESG_CHANNEL_MESG_PERIOD_ID, buf, 3);
-}
-
-uchar
-ANT_SetChannelSearchTimeout(uchar chan, uchar timeout)
-{
- return msg_send2(MESG_CHANNEL_SEARCH_TIMEOUT_ID, chan, timeout);
-}
-
-uchar
-ANT_SetSearchWaveform(uchar chan, ushort waveform)
-{
- uchar buf[3];
- buf[0] = chan;
- buf[1] = waveform%256;
- buf[2] = waveform/256;
- return msg_send(MESG_SEARCH_WAVEFORM_ID, buf, 3);
-}
-
-uchar
-ANT_SendAcknowledgedDataA(uchar chan, uchar *data) // ascii version
-{
- uchar buf[9];
- int i;
-
- if (strlen(data) != 16) {
- fprintf(stderr, "Bad data length %s\n", data);
- return 0;
- }
- buf[0] = chan;
- for (i = 0; i < 8; i++)
- buf[1+i] = hexval(data[i*2])*16+hexval(data[i*2+1]);
- return msg_send(MESG_ACKNOWLEDGED_DATA_ID, buf, 9);
-}
-
-uchar
-ANT_SendAcknowledgedData(uchar chan, uchar *data)
-{
- uchar buf[9];
- int i;
-
- buf[0] = chan;
- memcpy(buf+1, data, 8);
- return msg_send(MESG_ACKNOWLEDGED_DATA_ID, buf, 9);
-}
-
-ushort
-ANT_SendBurstTransferA(uchar chan, uchar *data, ushort numpkts)
-{
- uchar buf[9];
- int i;
- int j;
- int seq = 0;
-
- if (dbg) fprintf(stderr, "numpkts %d data %s\n", numpkts, data);
- if (strlen(data) != 16*numpkts) {
- fprintf(stderr, "Bad data length %s numpkts %d\n", data, numpkts);
- return 0;
- }
- for (j = 0; j < numpkts; j++) {
- buf[0] = chan|(seq<<5)|(j==numpkts-1 ? 0x80 : 0);
- 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);
- seq++; if (seq > 3) seq = 1;
- }
- return numpkts;
-}
-
-ushort
-ANT_SendBurstTransfer(uchar chan, uchar *data, ushort numpkts)
-{
- uchar buf[9];
- int i;
- int j;
- int seq = 0;
-
- for (j = 0; j < numpkts; j++) {
- 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);
- seq++; if (seq > 3) seq = 1;
- }
- return numpkts;
-}
-
-uchar
-ANT_OpenChannel(uchar chan)
-{
- return msg_send(MESG_OPEN_CHANNEL_ID, &chan, 1);
-}
-
-uchar
-ANT_CloseChannel(uchar chan)
-{
- return msg_send(MESG_CLOSE_CHANNEL_ID, &chan, 1);
-}
-
-void
-ANT_AssignResponseFunction(RESPONSE_FUNC rf, uchar* rbuf)
-{
- rfn = rf;
- rbufp = rbuf;
-}
-
-void
-ANT_AssignChannelEventFunction(uchar chan, CHANNEL_EVENT_FUNC rf, uchar* rbuf)
-{
- cfn = rf;
- cbufp = rbuf;
-}
-
-int ANT_fd()
-{
- return fd;
-}
-
-// vim: se ts=2 sw=2:
+++ /dev/null
-// copyright 2008-2009 paul@ant.sbrk.co.uk. released under GPLv3
-// copyright 2009-2009 Wali
-// vers 0.6t
-#include <stdio.h>
-#include <sys/select.h>
-#include <sys/time.h>
-#include <sys/types.h>
-#include <unistd.h>
-#include <string.h>
-#include <stdlib.h>
-#include <sys/stat.h>
-#include <fcntl.h>
-#include <assert.h>
-#include <time.h>
-#include <math.h>
-
-#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, "<?xml version=\"1.0\" encoding=\"UTF-8\" standalone=\"no\" ?>\n");
- fprintf(tcxfile, "<TrainingCenterDatabase xmlns=\"http://www.garmin.com/xmlschemas/TrainingCenterDatabase/v2\" xmlns:xsi=\"http://www.w3.org/2001/XMLSchema-instance\" xsi:schemaLocation=\"http://www.garmin.com/xmlschemas/ActivityExtension/v2 http://www.garmin.com/xmlschemas/ActivityExtensionv2.xsd http://www.garmin.com/xmlschemas/TrainingCenterDatabase/v2 http://www.garmin.com/xmlschemas/TrainingCenterDatabasev2.xsd\">\n\n");
- fprintf(tcxfile, " <Activities>\n");
- return;
-}
-
-void
-print_tcx_footer(FILE *tcxfile)
-{
- fprintf(tcxfile, " </Track>\n");
- fprintf(tcxfile, " </Lap>\n");
- fprintf(tcxfile, " <Creator xsi:type=\"Device_t\">\n");
- fprintf(tcxfile, " <Name>%s</Name>\n", modelname);
- fprintf(tcxfile, " <UnitId>%u</UnitId>\n", unitid);
- fprintf(tcxfile, " <ProductID>%u</ProductID>\n", part);
- fprintf(tcxfile, " <Version>\n");
- fprintf(tcxfile, " <VersionMajor>%u</VersionMajor>\n", ver/100);
- fprintf(tcxfile, " <VersionMinor>%u</VersionMinor>\n", ver - ver/100*100);
- fprintf(tcxfile, " <BuildMajor>0</BuildMajor>\n");
- fprintf(tcxfile, " <BuildMinor>0</BuildMinor>\n");
- fprintf(tcxfile, " </Version>\n");
- fprintf(tcxfile, " </Creator>\n");
- fprintf(tcxfile, " </Activity>\n");
- fprintf(tcxfile, " </Activities>\n\n");
- fprintf(tcxfile, " <Author xsi:type=\"Application_t\">\n");
- fprintf(tcxfile, " <Name>Garmin ANT for Linux</Name>\n");
- fprintf(tcxfile, " <Build>\n");
- fprintf(tcxfile, " <Version>\n");
- fprintf(tcxfile, " <VersionMajor>%u</VersionMajor>\n", majorrelease);
- fprintf(tcxfile, " <VersionMinor>%u</VersionMinor>\n", minorrelease);
- fprintf(tcxfile, " <BuildMajor>0</BuildMajor>\n");
- fprintf(tcxfile, " <BuildMinor>0</BuildMinor>\n");
- fprintf(tcxfile, " </Version>\n");
- fprintf(tcxfile, " <Type>Release</Type>\n");
- fprintf(tcxfile, " <Time>%s</Time>\n", releasetime);
- fprintf(tcxfile, " <Builder>make</Builder>\n");
- fprintf(tcxfile, " </Build>\n");
- fprintf(tcxfile, " <LangID>EN</LangID>\n");
- fprintf(tcxfile, " <PartNumber>006-A0XXX-00</PartNumber>\n");
- fprintf(tcxfile, " </Author>\n\n");
- fprintf(tcxfile, "</TrainingCenterDatabase>\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, "%d.%m.%Y %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, " <Activity Sport=\"");
- switch(sporttyp_track[track_id-firsttrack_id]) {
- case 0: fprintf(tcxfile, "Running"); break;
- case 1: fprintf(tcxfile, "Biking"); break;
- case 2: fprintf(tcxfile, "Other"); break;
- default: fprintf(tcxfile, "unknown value: %d",sporttyp_track[track_id-firsttrack_id]);
- }
- fprintf(tcxfile, "\">\n");
- fprintf(tcxfile, " <Id>%s</Id>\n", tbuf);
- } else {
- fprintf(tcxfile, " </Track>\n");
- fprintf(tcxfile, " </Lap>\n");
- }
- fprintf(tcxfile, " <Lap StartTime=\"%s\">\n", tbuf);
- fprintf(tcxfile, " <TotalTimeSeconds>%s</TotalTimeSeconds>\n", ground(tsec/100));
- fprintf(tcxfile, " <DistanceMeters>%s</DistanceMeters>\n", ground(dist));
- fprintf(tcxfile, " <MaximumSpeed>%s</MaximumSpeed>\n", ground(max_speed));
- fprintf(tcxfile, " <Calories>%d</Calories>\n", cal);
- if (hr_av > 0) {
- fprintf(tcxfile, " <AverageHeartRateBpm xsi:type=\"HeartRateInBeatsPerMinute_t\">\n");
- fprintf(tcxfile, " <Value>%d</Value>\n", hr_av);
- fprintf(tcxfile, " </AverageHeartRateBpm>\n");
- }
- if (hr_max > 0) {
- fprintf(tcxfile, " <MaximumHeartRateBpm xsi:type=\"HeartRateInBeatsPerMinute_t\">\n");
- fprintf(tcxfile, " <Value>%d</Value>\n", hr_max);
- fprintf(tcxfile, " </MaximumHeartRateBpm>\n");
- }
- fprintf(tcxfile, " <Intensity>");
- 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, "</Intensity>\n");
- if (cad != 255) {
- if (sporttyp_track[track_id-firsttrack_id] == 0) {
- fprintf(tcxfile, " <RunCadence>%d</RunCadence>\n", cad);
- } else {
- fprintf(tcxfile, " <Cadence>%d</Cadence>\n", cad);
- }
- }
- fprintf(tcxfile, " <TriggerMethod>");
- 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, "</TriggerMethod>\n");
- fprintf(tcxfile, " <Track>\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, " </Track>\n");
- fprintf(tcxfile, " <Track>\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, " <Trackpoint>\n");
- fprintf(tcxfile, " <Time>%s</Time>\n",tbuf);
- if (lat < 90) {
- fprintf(tcxfile, " <Position>\n");
- fprintf(tcxfile, " <LatitudeDegrees>%s</LatitudeDegrees>\n",
- ground(lat));
- fprintf(tcxfile, " <LongitudeDegrees>%s</LongitudeDegrees>\n",
- ground(lon));
- fprintf(tcxfile, " </Position>\n");
- fprintf(tcxfile, " <AltitudeMeters>%s</AltitudeMeters>\n", ground(alt));
- }
- // last trackpoint has utopic distance, 40000km should be enough, hack?
- if (dist < (float)40000000) {
- fprintf(tcxfile, " <DistanceMeters>%s</DistanceMeters>\n", ground(dist));
- }
- if (hr > 0) {
- fprintf(tcxfile, " <HeartRateBpm xsi:type=\"HeartRateInBeatsPerMinute_t\">\n");
- fprintf(tcxfile, " <Value>%d</Value>\n", hr);
- fprintf(tcxfile, " </HeartRateBpm>\n");
- }
- if (u1 > 0 && cad != 255) {
- fprintf(tcxfile, " <Cadence>%d</Cadence>\n", cad);
- }
- if (dist < (float)40000000) {
- fprintf(tcxfile, " <SensorState>%s</SensorState>\n", u1 ? "Present" : "Absent");
- fprintf(tcxfile, " <Extensions>\n");
- fprintf(tcxfile, " <TPX xmlns=\"http://www.garmin.com/xmlschemas/ActivityExtension/v2\" CadenceSensor=\"");
- // get type of pod from data, could not figure it out, so using sporttyp of first track
- switch(sporttyp_track[track_id-firsttrack_id]) {
- case 1: fprintf(tcxfile, "Bike\""); break;
- case 0:
- default: fprintf(tcxfile, "Footpod\""); break;
- }
- if (u1 == 0 && cad != 255) {
- fprintf(tcxfile, ">\n");
- fprintf(tcxfile, " <RunCadence>%d</RunCadence>\n", cad);
- fprintf(tcxfile, " </TPX>\n");
- } else {
- fprintf(tcxfile, "/>\n");
- }
- fprintf(tcxfile, " </Extensions>\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, " </Trackpoint>\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);
-}
projects / gant / commitdiff