X-Git-Url: https://git.kernelconcepts.de/?p=metawatch.git;a=blobdiff_plain;f=metawatch.c;h=2d9b929e2da28c83f32b35294fbb42365f92494e;hp=f4ad1d1f09277230c473f3bc5761089bcf94dff4;hb=b11171caa5c6ef0a685c134ea01b89a8330bd74e;hpb=ebb651f825a056f204a2fb36184d5f07a25df079 diff --git a/metawatch.c b/metawatch.c index f4ad1d1..2d9b929 100644 --- a/metawatch.c +++ b/metawatch.c @@ -51,6 +51,10 @@ const char *mw_status_string[] = { #define MW_FRAME_DELAY 0x00 +/* ---------------------------------------------------------------------- + * Debugging helpers + * ---------------------------------------------------------------------- */ + void dump_frame(unsigned char *frame, int len) { int i; @@ -61,7 +65,7 @@ void dump_frame(unsigned char *frame, int len) } -int mw_send_frame(int mw_fd, unsigned char msg_type, unsigned char options, unsigned char *data, unsigned char len) +int mw_send_frame(mwdevice_t *mwdevice, unsigned char msg_type, unsigned char options, unsigned char *data, unsigned char len) { unsigned short crc; unsigned char frame[64]; @@ -83,7 +87,7 @@ int mw_send_frame(int mw_fd, unsigned char msg_type, unsigned char options, unsi dump_frame(frame, tlen); #endif - while (((ret = write(mw_fd, frame, tlen)) >= 0) && (tlen > 0)) + while (((ret = write(mwdevice->mw_fd, frame, tlen)) >= 0) && (tlen > 0)) tlen -= ret; if (MW_FRAME_DELAY) @@ -101,7 +105,7 @@ int mw_send_frame(int mw_fd, unsigned char msg_type, unsigned char options, unsi * ---------------------------------------------------------------------- */ -void mw_set_rtc(int mw_fd, unsigned char clk1224, unsigned char date_fmt) +int mw_set_rtc(mwdevice_t *mwdevice, unsigned char clk1224, unsigned char date_fmt) { time_t mtime; struct tm mtm; @@ -123,10 +127,26 @@ void mw_set_rtc(int mw_fd, unsigned char clk1224, unsigned char date_fmt) data[8] = clk1224; data[9] = date_fmt; - mw_send_frame(mw_fd, MW_SET_REAL_TIME_CLOCK, 0, data, 10); + return mw_send_frame(mwdevice, MW_SET_REAL_TIME_CLOCK, 0, data, 10); +} + +int mw_nval_operation(mwdevice_t *mwdevice, unsigned char operation, unsigned short identifier, unsigned char size, void *mdata) +{ + unsigned char data[32]; + + data[0] = (identifier & 0xff00) >> 8; + data[1] = (identifier & 0x00ff); + 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; } -void mw_set_vibrate_mode(int mw_fd, unsigned char enable, unsigned short on_time, unsigned short off_time, unsigned char cycles) +int mw_set_vibrate_mode(mwdevice_t *mwdevice, unsigned char enable, unsigned short on_time, unsigned short off_time, unsigned char cycles) { unsigned char mdata[7]; @@ -134,32 +154,35 @@ void mw_set_vibrate_mode(int mw_fd, unsigned char enable, unsigned short on_time *(unsigned short *)(mdata+1) = on_time; /* miliseconds */ *(unsigned short *)(mdata+3) = off_time; /* miliseconds */ mdata[5] = cycles; - mw_send_frame(mw_fd, MW_SET_VIBRATE_MODE, 0, mdata, 6); + + return mw_send_frame(mwdevice, MW_SET_VIBRATE_MODE, 0, mdata, 6); } -void mw_configure_watch_mode(int mw_fd, unsigned char mode, unsigned char save, unsigned char timeout, unsigned char invert) +int mw_configure_watch_mode(mwdevice_t *mwdevice, unsigned char mode, unsigned char save, unsigned char timeout, unsigned char invert) { unsigned char mdata[3]; mdata[0] = timeout; /* seconds */ mdata[1] = invert; /* 0=normal, 1=invert */ - mw_send_frame(mw_fd, MW_CONFIGURE_MODE, (mode & 0x0f) | ((save & 0x01) << 4), mdata, 2); + + return mw_send_frame(mwdevice, MW_CONFIGURE_MODE, (mode & 0x0f) | ((save & 0x01) << 4), mdata, 2); } -void mw_update_display(int mw_fd, unsigned char mode, unsigned char copy) +int mw_update_display(mwdevice_t *mwdevice, unsigned char mode, unsigned char copy) { - mw_send_frame(mw_fd, MW_UPDATE_DISPLAY, (mode & 0x0f) | ((copy & 0x01) << 4), NULL, 0); + return mw_send_frame(mwdevice, MW_UPDATE_DISPLAY, (mode & 0x0f) | ((copy & 0x01) << 4), NULL, 0); } -void mw_load_template(int mw_fd, unsigned char mode, unsigned char template_select) +int mw_load_template(mwdevice_t *mwdevice, unsigned char mode, unsigned char template_select) { - mw_send_frame(mw_fd, MW_LOAD_TEMPLATE, (mode & 0x0f), &template_select, 1); + return mw_send_frame(mwdevice, MW_LOAD_TEMPLATE, (mode & 0x0f), &template_select, 1); } /* * send line for screen-mode mode from *buffer to watch, starting at display row row_offset + * this is only for digital LCD watch */ -void mw_write_buffer(int mw_fd, +int mw_write_buffer(mwdevice_t *mwdevice, unsigned char mode, unsigned char numlines, /* number of lines, 0=two lines or 1=one line */ unsigned char row_offset, /* start at row_offset in display, e.g. lower part in idle @31 */ @@ -167,10 +190,13 @@ void mw_write_buffer(int mw_fd, { unsigned char mdata[32]; + if (mwdevice->devtype != MW_DEVICE_TYPE_DIGITAL && mwdevice->devtype != MW_DEVICE_TYPE_DEVB_DIGI) + return -1; + buflen = 12 * (buflen / 12); /* crop to 12 bytes */ if ((numlines == 0 && buflen < 12) || (numlines == 1 && buflen < 24)) { fprintf(stderr, "mw_write_buffer: bufferlen does not match number of lines\n"); - return; + return -1; }; memset(mdata, 0, 32); mdata[0] = row_offset; @@ -179,10 +205,58 @@ void mw_write_buffer(int mw_fd, mdata[13] = row_offset+1; memcpy((mdata+14), (buffer+12), 12); }; - mw_send_frame(mw_fd, MW_WRITE_BUFFER, (mode & 0x0f) | (((numlines & 0x01)<< 4) & 0x10), mdata, numlines ? 13 : 26); + + return mw_send_frame(mwdevice, MW_WRITE_BUFFER, (mode & 0x0f) | (((numlines & 0x01)<< 4) & 0x10), mdata, numlines ? 13 : 26); } -void mw_enable_button(int mw_fd, +/* + Options: + B0 : row select, 0 first row, 1 second row + B1 : display select, 0 upper OLED, 1 lower OLED + B2 : if 1 send an event upon completion + B3..4: scroll type, + B5..7: unused + Scroll types: + B0: First buffer in a chain of scroll buffers + B1: Any buffer except first or last + B2: Last buffer of a chain + B3: reserved / unused + Payload: + 0: Start index col + 1..: data +*/ +int mw_write_oled_buffer(mwdevice_t *mwdevice, + unsigned char mode, /* idle or scroll */ + unsigned char oled, /* which OLED */ + unsigned char numcols, + unsigned char col_index, /* starting index */ + unsigned char *buffer, int buflen) +{ + unsigned char mdata[32]; + int i; + + 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); +} + + /* ---------------------------------------------------------------------- * 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_get_real_time_clock_response(int mw_fd, unsigned char *rtcrsp, int len) +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; @@ -227,7 +365,7 @@ void mw_get_real_time_clock_response(int mw_fd, unsigned char *rtcrsp, int len) if (len != 10) { fprintf(stderr, "get real time clock response length wrong %d != 10\n", len); - return; + return -1; } year = *(unsigned short *)rtcrsp; @@ -241,20 +379,51 @@ void mw_get_real_time_clock_response(int mw_fd, unsigned char *rtcrsp, int len) 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"); +#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); + + return 0; } -void mw_get_battery_voltage_response(int mw_fd, unsigned char *batrsp, int len) +void mw_set_get_real_time_clock_response_cb(mwdevice_t *mwdevice, void (*mw_get_real_time_clock_response_cb) (mwdevice_t *mwdevice, struct tm *mw_tm, void *user_data), void *user_data) +{ + if (mw_get_real_time_clock_response_cb != NULL) + mwdevice->mw_get_real_time_clock_response_cb = mw_get_real_time_clock_response_cb; + if (user_data != NULL) + mwdevice->mw_grtcrsp_data = user_data; +} + + +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]; - fprintf(stderr, "battery is at %dV, %s and %s\n", voltage, power_good ? "power is good" : "power fault", bat_charging ? "charging" : "not charging"); +#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"); +#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); + + 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) +{ + if (mw_get_battery_voltage_response_cb != NULL) + mwdevice->mw_get_battery_voltage_response_cb = mw_get_battery_voltage_response_cb; + if (user_data != NULL) + mwdevice->mw_gbatvrsp_data = user_data; } -void mw_read_button_config_response(int mw_fd, unsigned char *btnrsp, int len) +int mw_read_button_config_response(mwdevice_t *mwdevice, unsigned char *btnrsp, int len) { +#ifdef DEBUG fprintf(stderr, "read button config response\n"); fprintf(stderr, "screen mode : 0x%02x\n", btnrsp[0]); fprintf(stderr, "button index : 0x%02x\n", btnrsp[1]); @@ -267,22 +436,63 @@ void mw_read_button_config_response(int mw_fd, unsigned char *btnrsp, int len) fprintf(stderr, ")\n"); fprintf(stderr, "callback msg type: 0x%02x\n", btnrsp[3]); fprintf(stderr, "callback msg opts: 0x%02d\n", btnrsp[4]); +#endif + + return 0; } -void mw_read_light_sensor_response(int mw_fd, unsigned char *lightrsp, int len) +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) +{ + if (mw_read_button_config_response_cb != NULL) + mwdevice->mw_read_button_config_response_cb = mw_read_button_config_response_cb; + if (user_data != NULL) + mwdevice->mw_rbtncnfrsp_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 voltage = *(unsigned short *)(lightrsp+2); + unsigned short light_level = *(unsigned short *)(lightrsp+2); - fprintf(stderr, "light sensor is at %d, power stat: %s and %s\n", voltage, power_good ? "power is good" : "power fault", bat_charging ? "charging" : "not charging"); +#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"); +#endif + + if (mwdevice->mw_read_light_sensor_response_cb != NULL) + mwdevice->mw_read_light_sensor_response_cb(mwdevice, &light_level, mwdevice->mw_rlsrsp_data); + + return 0; } -void mw_status_change_event(int mw_fd, unsigned char option, unsigned char *statrsp, int len) +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) { + if (mw_read_light_sensor_response_cb != NULL) + mwdevice->mw_read_light_sensor_response_cb = mw_read_light_sensor_response_cb; + if (user_data != NULL) + mwdevice->mw_rlsrsp_data = user_data; +} + +int mw_status_change_event(mwdevice_t *mwdevice, unsigned char option, unsigned char *statrsp, int len) +{ + 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]]); #endif + + if (mwdevice->mw_status_change_event_cb != NULL) + mwdevice->mw_status_change_event_cb(mwdevice, &mode, &status, mwdevice->mw_stchev_data); + + return 0; +} + +void mw_set_status_change_event_cb(mwdevice_t *mwdevice, void (*mw_status_change_event_cb) (mwdevice_t *mwdevice, unsigned char *scrmode, unsigned char *status, void *user_data), void *user_data) +{ + if (mw_status_change_event_cb != NULL) + mwdevice->mw_status_change_event_cb = mw_status_change_event_cb; + if (user_data != NULL) + mwdevice->mw_stchev_data = user_data; } @@ -290,8 +500,7 @@ void mw_status_change_event(int mw_fd, unsigned char option, unsigned char *stat * Protocol handling * ---------------------------------------------------------------------- */ - -int decode_frame(int mw_fd, unsigned char *buf, int len) +int mw_decode_frame(mwdevice_t *mwdevice, unsigned char *buf, int len) { unsigned short crc; unsigned char msglen; @@ -304,20 +513,12 @@ int decode_frame(int mw_fd, unsigned char *buf, int len) crc = *(unsigned short *)(buf+len-2); if (crc != crc16ccitt(buf, len-2)) { fprintf(stderr, "decode frame CRC error\n"); - return 1; + 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; + return -1; } -#ifdef DEBUG - else - fprintf(stderr, "decode frame found SOF\n"); -#endif msglen = buf[1]; msgtype = buf[2]; @@ -327,46 +528,26 @@ int decode_frame(int mw_fd, 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; - }; + mw_get_device_type_response(mwdevice, msgdata[0]); break; case MW_GET_INFORMATION_STRING_RSP: msgdata[len-2] = 0; fprintf(stderr, "Got info string '%s'\n", msgdata); break; case MW_GET_REAL_TIME_CLOCK_RSP: - mw_get_real_time_clock_response(mw_fd, msgdata, msgdatalen); + mw_get_real_time_clock_response(mwdevice, msgdata, msgdatalen); break; case MW_READ_BATTERY_VOLTAGE_RSP: - mw_get_battery_voltage_response(mw_fd, msgdata, msgdatalen); + mw_get_battery_voltage_response(mwdevice, msgdata, msgdatalen); break; case MW_READ_LIGHT_SENSOR_RSP: - mw_read_light_sensor_response(mw_fd, msgdata, msgdatalen); + 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; case MW_READ_BUTTON_CONFIG_RSP: - mw_read_button_config_response(mw_fd, msgdata, msgdatalen); + mw_read_button_config_response(mwdevice, msgdata, msgdatalen); break; case MW_BUTTON_EVENT_MESSAGE: fprintf(stderr, "Button event message\n"); @@ -374,22 +555,120 @@ int decode_frame(int mw_fd, unsigned char *buf, int len) case MW_LOW_BATTERY_BT_OFF_MSG: fprintf(stderr, "Watch battery extremely low - radio will turn off\n"); 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(mw_fd, msgopt, msgdata, msgdatalen); + mw_status_change_event(mwdevice, msgopt, msgdata, msgdatalen); break; default: fprintf(stderr, "Unkown msgtype 0x%02x\n", msgtype); break; }; + return msglen; +} + + +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 + * ---------------------------------------------------------------------- */ + +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); + + return 0; +} + /* ---------------------------------------------------------------------- * Convenience functions not strictly part of the protocol * ---------------------------------------------------------------------- */ +int mw_get_resolution(mwdevice_t *mwdevice, unsigned int *width, unsigned int *height) +{ + if (width == NULL || height == NULL) + return -1; + + switch (mwdevice->devtype) { + case MW_DEVICE_TYPE_RESERVED: + return -1; + case MW_DEVICE_TYPE_ANA_DIGI: + case MW_DEVICE_TYPE_DEVB_ANA_DIGI: + *width = 80; + *height = 16; + break; + case MW_DEVICE_TYPE_DIGITAL: + case MW_DEVICE_TYPE_DEVB_DIGI: + *width = 96; + *height = 96; + break; + default: + break; + }; + + return 0; +} + + /* if flip=1 bits in each byte are inverted 7->1, 6->2, 5->3,... if invert=1 each byte is inverted */ @@ -412,7 +691,7 @@ void bmap_buffer_flipinvert(unsigned char flip, unsigned char invert, unsigned c } -void mw_send_bitmap(int mw_fd, unsigned char mode, int width, int height, int offset, unsigned char *bmapbuf, int buflen) +void mw_send_bitmap(mwdevice_t *mwdevice, unsigned char mode, int width, int height, int offset, unsigned char *bmapbuf, int buflen) { #ifdef DEBUG unsigned int i, x; @@ -442,7 +721,7 @@ void mw_send_bitmap(int mw_fd, unsigned char mode, int width, int height, int of memset(mw_buf, 0, 24); memcpy(mw_buf, (bmapbuf+(y*rowlength)), (rowlength > 12) ? 12 : rowlength); memcpy((mw_buf+12), (bmapbuf+((y+1)*rowlength)), (rowlength > 12) ? 12 : rowlength); - mw_write_buffer(mw_fd, mode, 0, offset+y, mw_buf, 24); + mw_write_buffer(mwdevice, mode, 0, offset+y, mw_buf, 24); } }