X-Git-Url: https://git.kernelconcepts.de/?p=metawatch.git;a=blobdiff_plain;f=metawatch.c;h=e093168d833fff9bb3bdf44b6fa8cd10ffb9fb9c;hp=08d5aca2bd08861837a07dd5b6fa64ef273c83e5;hb=5668a2fcb129077040e1856c5a3d1595c7ef06e7;hpb=36bbcbe1824acc18b9bc48426de62d862283dfc0 diff --git a/metawatch.c b/metawatch.c index 08d5aca..e093168 100644 --- a/metawatch.c +++ b/metawatch.c @@ -90,6 +90,7 @@ int mw_send_frame(mwdevice_t *mwdevice, unsigned char msg_type, unsigned char op while (((ret = write(mwdevice->mw_fd, frame, tlen)) >= 0) && (tlen > 0)) tlen -= ret; + fsync(mwdevice->mw_fd); if (MW_FRAME_DELAY) usleep(MW_FRAME_DELAY); @@ -105,29 +106,38 @@ int mw_send_frame(mwdevice_t *mwdevice, unsigned char msg_type, unsigned char op * ---------------------------------------------------------------------- */ -int mw_set_rtc(mwdevice_t *mwdevice, unsigned char clk1224, unsigned char date_fmt) +int mw_set_rtc(mwdevice_t *mwdevice, struct tm *mw_tm) { - time_t mtime; - struct tm mtm; unsigned short year; unsigned char data[32]; - mtime = time(NULL); - localtime_r(&mtime, &mtm); - - year = mtm.tm_year + 1900; + year = mw_tm->tm_year + 1900; data[0] = (year & 0x0f00) >> 8; data[1] = (year & 0x00ff); - data[2] = mtm.tm_mon + 1; - data[3] = mtm.tm_mday; - data[4] = mtm.tm_wday; - data[5] = mtm.tm_hour; - data[6] = mtm.tm_min; - data[7] = mtm.tm_sec; - data[8] = clk1224; - data[9] = date_fmt; + data[2] = mw_tm->tm_mon + 1; + data[3] = mw_tm->tm_mday; + data[4] = mw_tm->tm_wday; + data[5] = mw_tm->tm_hour; + data[6] = mw_tm->tm_min; + data[7] = mw_tm->tm_sec; + + return mw_send_frame(mwdevice, MW_SET_REAL_TIME_CLOCK, 0, data, 8); +} + +int mw_nval_operation(mwdevice_t *mwdevice, unsigned char operation, unsigned short identifier, unsigned char size, void *mdata) +{ + unsigned char data[32]; - return mw_send_frame(mwdevice, MW_SET_REAL_TIME_CLOCK, 0, data, 10); + data[0] = (identifier & 0x00ff); + data[1] = (identifier & 0xff00) >> 8; + data[2] = size; + if (size > 0 && mdata != NULL) + memcpy((data+3), mdata, size); + + if (operation == MW_NVAL_OPERATION_READ || operation == MW_NVAL_OPERATION_WRITE) { + return mw_send_frame(mwdevice, MW_NVAL_OPERATION, operation, data, 3+size); + } else + return -1; } int mw_set_vibrate_mode(mwdevice_t *mwdevice, unsigned char enable, unsigned short on_time, unsigned short off_time, unsigned char cycles) @@ -154,6 +164,7 @@ int mw_configure_watch_mode(mwdevice_t *mwdevice, unsigned char mode, unsigned c int mw_update_display(mwdevice_t *mwdevice, unsigned char mode, unsigned char copy) { + mwdevice->screen_mode = (mode & 0x0f); return mw_send_frame(mwdevice, MW_UPDATE_DISPLAY, (mode & 0x0f) | ((copy & 0x01) << 4), NULL, 0); } @@ -222,6 +233,7 @@ int mw_write_oled_buffer(mwdevice_t *mwdevice, if (mwdevice->devtype != MW_DEVICE_TYPE_ANA_DIGI && mwdevice->devtype != MW_DEVICE_TYPE_DEVB_ANA_DIGI) return -1; + fprintf(stderr, "write oled buf len = %d\n", buflen); /* lower row first since display wil be updated after completion of upper row */ if (buflen > 80) { for (i=80; i 12) + return -1; + if (minutes > 60) + return -1; + if (seconds > 60) + return -1; + + mdata[0] = hours; + mdata[1] = minutes; + mdata[2] = seconds; + + return mw_send_frame(mwdevice, MW_ADVANCE_WATCH_HANDS, 0, mdata, 3); +} + +int mw_battery_configuration(mwdevice_t *mwdevice, unsigned char warn_lvl, unsigned char bt_off_lvl) +{ + unsigned char mdata[4]; + + if (warn_lvl < 28 || warn_lvl > 42) + return -1; + if (bt_off_lvl < 28 || bt_off_lvl > 42) + return -1; + + mdata[0] = warn_lvl; + mdata[1] = bt_off_lvl; + + return mw_send_frame(mwdevice, MW_BATTERY_CONFIG_MSG, 0, mdata, 2); +} + + /* ---------------------------------------------------------------------- * Watch responses, events or notifications * ---------------------------------------------------------------------- */ +int mw_get_device_type_response(mwdevice_t *mwdevice, unsigned char devtype) +{ +#ifdef DEBUG + fprintf(stderr, "Got device type "); + switch(devtype) { + case 0: + fprintf(stderr, "Reserved\n"); + break; + case 1: + fprintf(stderr, "Ana-Digi\n"); + break; + case 2: + fprintf(stderr, "Digital\n"); + break; + case 3: + fprintf(stderr, "Development Board Digital\n"); + break; + case 4: + fprintf(stderr, "Development Board Ana-Digi\n"); + break; + default: + fprintf(stderr, "unknown %d\n", devtype); + break; + }; +#endif + mwdevice->devtype = devtype; + if (mwdevice->mw_get_device_type_response_cb != NULL) + mwdevice->mw_get_device_type_response_cb(mwdevice, devtype, mwdevice->mw_gdtypersp_data); + return 0; +} + +void mw_set_get_device_type_response_cb(mwdevice_t *mwdevice, void (*mw_get_device_type_response_cb) (mwdevice_t *mwdevice, unsigned char devtype, void *user_data), void *user_data) +{ + if (mw_get_device_type_response_cb != NULL) + mwdevice->mw_get_device_type_response_cb = mw_get_device_type_response_cb; + if (user_data != NULL) + mwdevice->mw_gdtypersp_data = user_data; +} + +int mw_nval_operation_response(mwdevice_t *mwdevice, unsigned char operation, unsigned short identifier, unsigned char size, void *mdata) +{ + return -1; +} int mw_get_real_time_clock_response(mwdevice_t *mwdevice, unsigned char *rtcrsp, int len) { struct tm mtm; unsigned short year; - unsigned char clk1224, date_fmt; - if (len != 10) { + if (len != 8) { fprintf(stderr, "get real time clock response length wrong %d != 10\n", len); return -1; } @@ -296,11 +385,9 @@ int mw_get_real_time_clock_response(mwdevice_t *mwdevice, unsigned char *rtcrsp, mtm.tm_hour = rtcrsp[5]; mtm.tm_min = rtcrsp[6]; mtm.tm_sec = rtcrsp[7]; - clk1224 = rtcrsp[8]; - date_fmt = rtcrsp[9]; #ifdef DEBUG - 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"); + fprintf(stderr, "watch RTC is %s\n", asctime(&mtm)); #endif if (mwdevice->mw_get_real_time_clock_response_cb != NULL) mwdevice->mw_get_real_time_clock_response_cb(mwdevice, &mtm, mwdevice->mw_grtcrsp_data); @@ -319,21 +406,22 @@ void mw_set_get_real_time_clock_response_cb(mwdevice_t *mwdevice, void (*mw_get_ int mw_get_battery_voltage_response(mwdevice_t *mwdevice, unsigned char *batrsp, int len) { - unsigned short voltage = *(unsigned short *)batrsp; - unsigned char power_good = batrsp[2]; - unsigned char bat_charging = batrsp[3]; + unsigned char power_good = batrsp[0]; + unsigned char bat_charging = batrsp[1]; + unsigned short voltage = *(unsigned short *)(batrsp+2); + unsigned short voltage_avg = *(unsigned short *)(batrsp+4); #ifdef DEBUG - fprintf(stderr, "battery is at %dmV, %s and %s\n", voltage, power_good ? "power is good" : "power fault", bat_charging ? "charging" : "not charging"); + fprintf(stderr, "battery is at %dmV (average is %dmV), %s and %s\n", voltage, voltage_avg, power_good ? "power is good" : "power fault", bat_charging ? "charging" : "not charging"); #endif if (mwdevice->mw_get_battery_voltage_response_cb != NULL) - mwdevice->mw_get_battery_voltage_response_cb(mwdevice, &voltage, &power_good, &bat_charging, mwdevice->mw_gbatvrsp_data); + mwdevice->mw_get_battery_voltage_response_cb(mwdevice, &voltage, &voltage_avg, &power_good, &bat_charging, mwdevice->mw_gbatvrsp_data); return 0; } -void mw_set_get_battery_voltage_response_cb(mwdevice_t *mwdevice, void (*mw_get_battery_voltage_response_cb) (mwdevice_t *mwdevice, unsigned short *voltage, unsigned char *pgood, unsigned char *charging, void *user_data), void *user_data) +void mw_set_get_battery_voltage_response_cb(mwdevice_t *mwdevice, void (*mw_get_battery_voltage_response_cb) (mwdevice_t *mwdevice, unsigned short *voltage, unsigned short *voltage_avg, unsigned char *pgood, unsigned char *charging, void *user_data), void *user_data) { if (mw_get_battery_voltage_response_cb != NULL) mwdevice->mw_get_battery_voltage_response_cb = mw_get_battery_voltage_response_cb; @@ -341,6 +429,7 @@ void mw_set_get_battery_voltage_response_cb(mwdevice_t *mwdevice, void (*mw_get_ mwdevice->mw_gbatvrsp_data = user_data; } +#if 0 int mw_read_button_config_response(mwdevice_t *mwdevice, unsigned char *btnrsp, int len) { #ifdef DEBUG @@ -360,6 +449,7 @@ int mw_read_button_config_response(mwdevice_t *mwdevice, unsigned char *btnrsp, return 0; } +#endif void mw_set_read_button_config_response_cb(mwdevice_t *mwdevice, void (*mw_read_button_config_response_cb) (mwdevice_t *mwdevice, void *user_data), void *user_data) { @@ -369,23 +459,42 @@ void mw_set_read_button_config_response_cb(mwdevice_t *mwdevice, void (*mw_read_ mwdevice->mw_rbtncnfrsp_data = user_data; } +int mw_button_event_message(mwdevice_t *mwdevice, unsigned char *btnevt, int len, unsigned char opts) +{ +#ifdef DEBUG + fprintf(stderr, "Button event message, button %d options %d\n", btnevt[0], opts); +#endif + + if (mwdevice->mw_button_event_message_cb != NULL) + mwdevice->mw_button_event_message_cb(mwdevice, btnevt[0], opts, mwdevice->mw_btnevmsg_data); + + return 0; +} + +void mw_set_button_event_message_cb(mwdevice_t *mwdevice, void (*mw_button_event_message_cb) (mwdevice_t *mwdevice, unsigned char buttons, unsigned char options, void *user_data), void *user_data) +{ + if (mw_button_event_message_cb != NULL) + mwdevice->mw_button_event_message_cb = mw_button_event_message_cb; + if (user_data != NULL) + mwdevice->mw_btnevmsg_data = user_data; +} + int mw_read_light_sensor_response(mwdevice_t *mwdevice, unsigned char *lightrsp, int len) { - unsigned char power_good = lightrsp[0]; - unsigned char bat_charging = lightrsp[1]; - unsigned short light_level = *(unsigned short *)(lightrsp+2); + unsigned short light_level = *(unsigned short *)(lightrsp); + unsigned short light_level_avg = *(unsigned short *)(lightrsp+2); #ifdef DEBUG - fprintf(stderr, "light sensor is at %d, power stat: %s and %s\n", light_level, power_good ? "power is good" : "power fault", bat_charging ? "charging" : "not charging"); + fprintf(stderr, "light sensor is at %d, average at %d\n", light_level, light_level_avg); #endif if (mwdevice->mw_read_light_sensor_response_cb != NULL) - mwdevice->mw_read_light_sensor_response_cb(mwdevice, &light_level, mwdevice->mw_rlsrsp_data); + mwdevice->mw_read_light_sensor_response_cb(mwdevice, &light_level, &light_level_avg, mwdevice->mw_rlsrsp_data); return 0; } -void mw_set_read_light_sensor_response_cb(mwdevice_t *mwdevice, void (*mw_read_light_sensor_response_cb) (mwdevice_t *mwdevice, unsigned short *light_level, void *user_data), void *user_data) +void mw_set_read_light_sensor_response_cb(mwdevice_t *mwdevice, void (*mw_read_light_sensor_response_cb) (mwdevice_t *mwdevice, unsigned short *light_level, unsigned short *light_level_avg, void *user_data), void *user_data) { if (mw_read_light_sensor_response_cb != NULL) mwdevice->mw_read_light_sensor_response_cb = mw_read_light_sensor_response_cb; @@ -398,9 +507,10 @@ int mw_status_change_event(mwdevice_t *mwdevice, unsigned char option, unsigned unsigned char mode = (option & 0x0f); unsigned char status = statrsp[0]; #ifdef DEBUG - fprintf(stderr, "Status change event for mode %s: %s\n", mw_screen_mode_names[option&0x0f], mw_status_string[statrsp[0]]); + fprintf(stderr, "Status change event for mode %s: %s\n", mw_screen_mode_names[mode], mw_status_string[status]); #endif + // mwdevice->screen_mode = mode; if (mwdevice->mw_status_change_event_cb != NULL) mwdevice->mw_status_change_event_cb(mwdevice, &mode, &status, mwdevice->mw_stchev_data); @@ -415,12 +525,49 @@ void mw_set_status_change_event_cb(mwdevice_t *mwdevice, void (*mw_status_change mwdevice->mw_stchev_data = user_data; } +int mw_low_battery_warning_message(mwdevice_t *mwdevice) +{ +#ifdef DEBUG + fprintf(stderr, "Watch battery low, please connect charger\n"); +#endif + if (mwdevice->mw_low_battery_warning_message_cb != NULL) + mwdevice->mw_low_battery_warning_message_cb(mwdevice, mwdevice->mw_lbatwarnmsg_data); + + return 0; +} + +void mw_set_low_battery_warning_message_cb(mwdevice_t *mwdevice, void (*mw_low_battery_warning_message_cb) (mwdevice_t *mwdevice, void *user_data), void *user_data) +{ + if (mw_low_battery_warning_message_cb != NULL) + mwdevice->mw_low_battery_warning_message_cb = mw_low_battery_warning_message_cb; + if (user_data != NULL) + mwdevice->mw_lbatwarnmsg_data = user_data; +} + +int mw_low_battery_bt_off_message(mwdevice_t *mwdevice) +{ +#ifdef DEBUG + fprintf(stderr, "Watch battery extremely low - radio will turn off\n"); +#endif + if (mwdevice->mw_low_battery_bt_off_message_cb != NULL) + mwdevice->mw_low_battery_bt_off_message_cb(mwdevice, mwdevice->mw_lbatbtoff_data); + + return 0; +} + +void mw_set_low_battery_bt_off_message_cb(mwdevice_t *mwdevice, void (*mw_low_battery_bt_off_message_cb) (mwdevice_t *mwdevice, void *user_data), void *user_data) +{ + if (mw_low_battery_bt_off_message_cb != NULL) + mwdevice->mw_low_battery_bt_off_message_cb = mw_low_battery_bt_off_message_cb; + if (user_data != NULL) + mwdevice->mw_lbatbtoff_data = user_data; +} /* ---------------------------------------------------------------------- * Protocol handling * ---------------------------------------------------------------------- */ -int decode_frame(mwdevice_t *mwdevice, unsigned char *buf, int len) +int mw_decode_frame(mwdevice_t *mwdevice, unsigned char *buf, int len) { unsigned short crc; unsigned char msglen; @@ -435,18 +582,10 @@ int decode_frame(mwdevice_t *mwdevice, unsigned char *buf, int len) fprintf(stderr, "decode frame CRC error\n"); return -1; } -#ifdef DEBUG - else - fprintf(stderr, "decode frame CRC OK\n"); -#endif if (buf[0] != MW_SOF) { fprintf(stderr, "decode frame SOF not found\n"); return -1; } -#ifdef DEBUG - else - fprintf(stderr, "decode frame found SOF\n"); -#endif msglen = buf[1]; msgtype = buf[2]; @@ -456,28 +595,7 @@ int decode_frame(mwdevice_t *mwdevice, unsigned char *buf, int len) switch (msgtype) { case MW_GET_DEVICE_TYPE_RSP: - fprintf(stderr, "Got device type "); - switch(msgdata[0]) { - case 0: - fprintf(stderr, "Reserved\n"); - break; - case 1: - fprintf(stderr, "Ana-Digi\n"); - break; - case 2: - fprintf(stderr, "Digital\n"); - break; - case 3: - fprintf(stderr, "Development Board Digital\n"); - break; - case 4: - fprintf(stderr, "Development Board Ana-Digi\n"); - break; - default: - fprintf(stderr, "unknown %d\n", msgdata[0]); - break; - }; - mwdevice->devtype = msgdata[0]; + mw_get_device_type_response(mwdevice, msgdata[0]); break; case MW_GET_INFORMATION_STRING_RSP: msgdata[len-2] = 0; @@ -492,23 +610,50 @@ int decode_frame(mwdevice_t *mwdevice, unsigned char *buf, int len) case MW_READ_LIGHT_SENSOR_RSP: mw_read_light_sensor_response(mwdevice, msgdata, msgdatalen); break; - case MW_LOW_BATTERY_WARNING_MSG: - fprintf(stderr, "Watch battery low, please connect charger\n"); - break; +#if 0 case MW_READ_BUTTON_CONFIG_RSP: mw_read_button_config_response(mwdevice, msgdata, msgdatalen); break; +#endif case MW_BUTTON_EVENT_MESSAGE: - fprintf(stderr, "Button event message\n"); + mw_button_event_message(mwdevice, msgdata, msgdatalen, msgopt); + break; + case MW_LOW_BATTERY_WARNING_MSG: + mw_low_battery_warning_message(mwdevice); break; case MW_LOW_BATTERY_BT_OFF_MSG: - fprintf(stderr, "Watch battery extremely low - radio will turn off\n"); + mw_low_battery_bt_off_message(mwdevice); + break; + case MW_NVAL_OPERATION_RSP: + fprintf(stderr, "NVAL operation response - "); + switch (msgopt) { + case 0x00: + fprintf(stderr, "success\n"); + break; + case 0x01: + fprintf(stderr, "failure!\n"); + break; + case 0x09: + fprintf(stderr, "Item Not initialized (Identifier Not found\n"); + break; + case 0x0a: + fprintf(stderr, "Operation failed\n"); + break; + case 0x0c: + fprintf(stderr, "Bad Item length\n"); + break; + default: + fprintf(stderr, "unknown status 0x%02x\n", msgopt); + break; + }; break; case MW_STATUS_CHANGE_EVENT: mw_status_change_event(mwdevice, msgopt, msgdata, msgdatalen); break; default: +#ifdef DEBUG fprintf(stderr, "Unkown msgtype 0x%02x\n", msgtype); +#endif break; }; @@ -516,6 +661,38 @@ int decode_frame(mwdevice_t *mwdevice, unsigned char *buf, int len) } +int mw_feed_msg_buffer(mwdevice_t *mwdevice, unsigned char *buf, int len) +{ + char msgbuf[64]; + int tlen; + + if (len <= 0) + return -1; + + memcpy((mwdevice->pbuf+mwdevice->pbuf_len), buf, len); + mwdevice->pbuf_len += len; + + while (mwdevice->pbuf_len > 0) { + /* scan for MW_SOF */ + while (mwdevice->pbuf[0] != MW_SOF) { + memmove(mwdevice->pbuf, (mwdevice->pbuf+1), --mwdevice->pbuf_len); + } + tlen = mwdevice->pbuf[1]; + /* OK, there is an SOF but the message is too short */ + if (tlen > mwdevice->pbuf_len) { + /* we have to wait for more data to come in */ + break; + } + /* here we have a complete msg */ + memcpy(msgbuf, mwdevice->pbuf, tlen); + mw_decode_frame(mwdevice, (unsigned char *)msgbuf, tlen); + memmove(mwdevice->pbuf, (mwdevice->pbuf+tlen), tlen); + mwdevice->pbuf_len -= tlen; + } + return 0; +} + + /* ---------------------------------------------------------------------- * General code usage * ---------------------------------------------------------------------- */ @@ -524,6 +701,8 @@ int mw_init(mwdevice_t *mwdevice, int mw_fd) { memset(mwdevice, 0, sizeof(mwdevice_t)); mwdevice->mw_fd = mw_fd; + memset(mwdevice->pbuf, 0, MW_PBUF_LEN); + mwdevice->pbuf_len = 0; /* figure out which device we run with */ mw_send_frame(mwdevice, MW_GET_DEVICE_TYPE, 0, NULL, 0);