nica/metawatch
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

Mostly reformatting

Browse source
This commit is contained in:
Nils Faerber 2011-07-23 17:56:24 +02:00
parent 5c2abd6bea
commit 33ec672c8d
2 changed files with 254 additions and 120 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

137
metawatch.c
View file

@ -20,6 +20,7 @@
void dump_frame(unsigned char *frame, int len)
{
int i;
for (i=0; i<len; i++)
fprintf(stderr, "0x%02x ", frame[i]);
fprintf(stderr, "\n");
@ -38,6 +39,7 @@ int mw_send_packet(int mw_fd, unsigned char msg_type, unsigned char options, uns
frame[1] = len + 6;
frame[2] = msg_type;
frame[3] = options;
if (data != NULL && len > 0)
memcpy(frame+4, data, len);
crc = crc16ccitt(frame, len+4);
@ -54,6 +56,10 @@ int mw_send_packet(int mw_fd, unsigned char msg_type, unsigned char options, uns
return ret;
}
/*
* host to watch commands
*/
void mw_set_rtc(int mw_fd, unsigned char clk1224, unsigned char date_fmt)
{
time_t mtime;
@ -79,9 +85,100 @@ void mw_set_rtc(int mw_fd, unsigned char clk1224, unsigned char date_fmt)
mw_send_packet(mw_fd, MW_SET_REAL_TIME_CLOCK, 0, data, 10);
}
/*
* watch responses, events or notifications
*/
void mw_get_real_time_clock_response(int mw_fd, unsigned char *rtcrsp, int len)
{
struct tm mtm;
unsigned short year;
unsigned char clk1224, date_fmt;
if (len != 10) {
fprintf(stderr, "get real time clock response too short %d != 10\n", len);
return;
}
year = *(unsigned short *)rtcrsp;
mtm.tm_year = year - 1900;
mtm.tm_mon = rtcrsp[2] - 1;
mtm.tm_mday = rtcrsp[3];
mtm.tm_wday = rtcrsp[4];
mtm.tm_hour = rtcrsp[5];
mtm.tm_min = rtcrsp[6];
mtm.tm_sec = rtcrsp[7];
clk1224 = rtcrsp[8];
date_fmt = rtcrsp[9];
fprintf(stderr, "watch RTC is %s, clock format is %s, date format is %s\n", asctime(&mtm), clk1224 ? "24h" : "AM/PM", date_fmt ? "DD/MM" : "MM/DD");
}
void mw_get_battery_voltage_response(int mw_fd, unsigned char *batrsp, int len)
{
unsigned short voltage = *(unsigned short *)batrsp;
unsigned char power_good = batrsp[2];
unsigned char bat_charging = batrsp[3];
fprintf(stderr, "battery is at %dV, %s and %s\n", voltage, power_good ? "power is good" : "power fault", bat_charging ? "charging" : "not charging");
}
int decode_frame(int mw_fd, unsigned char *buf, int len)
{
unsigned short crc;
unsigned char msglen;
unsigned char msgtype;
unsigned char msgopt;
unsigned char *msgdata;
/* check frame */
crc = *(unsigned short *)(buf+len-2);
if (crc != crc16ccitt(buf, len-2)) {
fprintf(stderr, "decode frame CRC error\n");
return 1;
} else
fprintf(stderr, "decode frame CRC OK\n");
if (buf[0] != MW_SOF) {
fprintf(stderr, "decode frame SOF not found\n");
return 1;
} else
fprintf(stderr, "decode frame found SOF\n");
msglen = buf[1];
msgtype = buf[2];
msgopt = buf[3];
msgdata = (buf+4);
switch (msgtype) {
case MW_GET_REAL_TIME_CLOCK_RSP:
mw_get_real_time_clock_response(mw_fd, msgdata, len-4-2);
break;
case MW_GET_INFORMATION_STRING_RSP:
msgdata[len-4-2] = 0;
fprintf(stderr, "Got info string '%s'\n", (msgdata+4));
break;
case MW_READ_BATTERY_VOLTAGE_RSP:
mw_get_battery_voltage_response(mw_fd, msgdata, len-4-2);
break;
case MW_LOW_BATTERY_WARNING_MSG:
fprintf(stderr, "Watch battery low, please connect charger\n");
break;
case MW_LOW_BATTERY_BT_OFF_MSG:
fprintf(stderr, "Watch battery extremely low - radio will turn off\n");
break;
default:
fprintf(stderr, "Unkown msgtype 0x%02x\n", msgtype);
break;
};
return 0;
}
void process_cmd(char *cmdline, int clinep, int mw_fd)
{
unsigned char mdata[32];
unsigned char *mdatap = mdata;
fprintf(stderr, "command: '%s'\n", cmdline);
if (strncmp(cmdline, "quit", 4) == 0) {
@ -94,6 +191,40 @@ void process_cmd(char *cmdline, int clinep, int mw_fd)
mw_set_rtc(mw_fd, MW_RTC_CLOCK_24HR, MW_RTC_DATE_DDMM);
fprintf(stderr, "OK\n");
}
if (strncmp(cmdline, "grtc", 4) == 0) {
mw_send_packet(mw_fd, MW_GET_REAL_TIME_CLOCK, 0, NULL, 0);
}
if (strncmp(cmdline, "gistr", 5) == 0) {
mdata[0] = 0;
mw_send_packet(mw_fd, MW_GET_INFORMATION_STRING, 0, mdata, 1);
}
if (strncmp(cmdline, "gdtype", 6) == 0) {
mw_send_packet(mw_fd, MW_GET_DEVICE_TYPE, 0, NULL, 0);
}
if (strncmp(cmdline, "rvbat", 5) == 0) {
mw_send_packet(mw_fd, MW_READ_BATTERY_VOLTAGE_MSG, 0, NULL, 0);
}
if (strncmp(cmdline, "modecfg", 6) == 0) {
memset(mdata, 0, 32);
mdata[0] = 4; /* timeout */
mdata[1] = 1; /* invert display */
mw_send_packet(mw_fd, MW_CONFIGURE_MODE, 0, mdata, 27);
}
if (strncmp(cmdline, "rbtcfg", 6) == 0) {
mdata[0] = 0; /* idle screen */
mdata[1] = 1; /* button index */
mdata[2] = 2; /* button press type */
mdata[3] = 3; /* callback message type */
mdata[4] = 4; /* callback message option */
mw_send_packet(mw_fd, MW_READ_BUTTON_CONFIG, 0, NULL, 0);
}
if (strncmp(cmdline, "svib", 4) == 0) {
mdata[0] = 1; /* enable */
*(unsigned short *)(mdatap+1) = 500; /* on miliseconds */
*(unsigned short *)(mdatap+3) = 500; /* off miliseconds */
mdata[5] = 10;
mw_send_packet(mw_fd, MW_SET_VIBRATE_MODE, 0, mdata, 6);
}
}
int menu(int mw_fd)
@ -110,6 +241,7 @@ int menu(int mw_fd)
tconfd.c_oflag |= ONLCR | OPOST;
tconfd.c_lflag |= ISIG;
tcsetattr(0, TCSANOW, &tconfd);
FD_ZERO(&mfds);
FD_SET(0, &mfds);
FD_SET(mw_fd, &mfds);
@ -121,10 +253,10 @@ int menu(int mw_fd)
if (select(mw_fd+1, &mfds, NULL, NULL, NULL) > 0) {
if (FD_ISSET(mw_fd, &mfds)) {
rcvd = read(mw_fd, msg_buf, 64);
printf("read %d bytes:\n", rcvd);
fprintf(stderr, "read %d bytes:\n", rcvd);
if (rcvd > 0) {
dump_frame(msg_buf, rcvd);
// decode_message(mw_fd, msg_buf, rcvd);
decode_frame(mw_fd, msg_buf, rcvd);
}
};
if (FD_ISSET(0, &mfds)) {
@ -180,3 +312,4 @@ int main(int argc, char **argv)
return 0;
};

1
metawatch_protocol.h
View file

@ -46,3 +46,4 @@
#endif