Add analog clockface display, command dana <hour> <minute> <day#>
[metawatch.git] / mw_main.c
index 4e871b4..eb98255 100644 (file)
--- a/mw_main.c
+++ b/mw_main.c
@@ -14,6 +14,7 @@
 #include <time.h>
 #include <termios.h>
 #include <ctype.h>
+#include <math.h>
 
 #include <errno.h>
 
 #include <dbus/dbus-glib.h>
 #include <dbus/dbus-glib-lowlevel.h>
 
+#include <libsoup/soup.h>
+
+#include <libxml/tree.h>
+#include <libxml/parser.h>
+
 /*
 #include <bluetooth/sdp.h>
 #include <bluetooth/sdp_lib.h>
@@ -34,6 +40,8 @@
 #include "crc16ccitt.h"
 #include "mw_utility.h"
 
+#include "bt_helper.h"
+
 typedef struct {
        GMainLoop *mloop;
        mwdevice_t mwdevice;
@@ -42,6 +50,8 @@ typedef struct {
        int con_fd;             /* console input fd */
        char cmdline[128];
        int cmdline_pos;
+       SoupSession *msoup;
+       SoupMessage *smsg;
 } mwdata_t;
 
 void bitmap_test(mwdevice_t *mwdevice)
@@ -231,6 +241,122 @@ void test_notification(mwdevice_t *mwdevice)
        mw_set_vibrate_mode(mwdevice, 1, 300, 300, 3);
 }
 
+int days(int m1, int y1)
+{
+       int d;
+       if(m1==1 || m1==3 || m1==5 || m1==7 || m1==8 || m1==10 || m1==12)
+               d=31;
+       else if(m1==4 || m1==6 || m1==9 || m1==11)
+               d=30;
+       else if((y1%100!=0 && y1%4==0) || y1%400==0)
+               d=29;
+       else
+               d=28;
+       return d;
+}
+
+void draw_idle_calendar(mwdevice_t *mwdevice)
+{
+       long unsigned int t;
+       unsigned int y,y1,m,m1,d,i,j,k;
+       /* const char a[12][20]={"January","February","March","April","May","June","July","August","September","October","November","December"}; */
+       const char dnames[7][3] = { "Mo", "Di", "Mi", "Do", "Fr", "Sa", "So" };
+       mw_buffer *mwbuf;
+       unsigned char *bbuf;
+       int len, px, py;
+       char pnum[32];
+       int today;
+       time_t mtime;
+       struct tm mtm;
+                               
+       mtime = time(NULL);
+       localtime_r(&mtime, &mtm);
+
+       today = mtm.tm_mday;
+       y = mtm.tm_year + 1900;
+       m = mtm.tm_mon + 1;
+
+       mwbuf = mw_alloc_pbuffer(96, 66, 1);
+       mw_buf_clear(mwbuf, MW_BLACK);
+
+       if (y < 0)
+               y = -y;
+       if (m <= 0 || m >= 13)
+               m = 1;
+       y1 = 0;
+       t = 0;
+       while (y1 < y) {
+               if (((y1 % 100) != 0 && (y1 % 4) == 0) || (y1 % 400) == 0)
+                       t += 366;
+               else
+                       t += 365;
+               y1++;
+       }
+       m1 = 1;
+       while (m1 < m) {
+               d = days(m1, y);
+               t = t + d;
+               m1++;
+       };
+#if 0
+       printf("Year: '%u'\n",y);
+       printf("Month: '%s'\n",a[m-1]);
+
+       printf("%6s%6s%6s%6s%6s%6s%6s\n","Sun","Mon","Tue","Wed","Thu","Fri","Sat");
+#endif
+
+       k = 1;
+       /* 0 = 1st day is Monday, 1 = 1st day is Sunday */
+       d = (t % 7)-1;
+       px=0;
+       py=3;
+       for (i=0; i<7; i++) {
+               snprintf(pnum, 3, "%s", dnames[i]);
+               mw_buf_print(mwbuf, px, py, pnum, 0, MW_WHITE, MW_BLACK);
+               px += 14;
+       };
+       px = 0;
+       py += 10;
+       for (i = 1; i <= days(m,y); i++, k++) {
+               if (i == 1) {
+                       if (d == 0) {
+                               for (j = 1; j < 7; j++, k++) {
+                                       printf("+--"); //printf("%3s","");
+                                       px += 14;
+                               }
+                       } else {
+                               for (j = 1; j < d; j++, k++) {
+                                       px += 14;
+                                       printf("--+"); //printf("%3s","");
+                               }
+                       }
+               }
+               snprintf(pnum, 8, "%2d", i);
+               if (i == today)
+                       mw_buf_print(mwbuf, px, py, pnum, 0, MW_BLACK, MW_WHITE);
+               else
+                       mw_buf_print(mwbuf, px, py, pnum, 0, MW_WHITE, MW_BLACK);
+               px += 12;
+               printf("%2d", i);
+               if ((k % 7) == 0) {
+                       printf("\n");
+                       px = 0;
+                       py += 10;
+               } else {
+                       printf("+");
+                       px += 2;
+               }
+       }
+       // printf("\n");
+
+       //mw_buf_print(mwbuf, 1, 10, "Font 0", 0, MW_WHITE, MW_BLACK);
+
+       bbuf = mw_make_mw_buffer(mwbuf, &len);
+       mw_send_bitmap(mwdevice, MW_SCREEN_MODE_IDLE, 96, 65, 31, bbuf, len);
+       mw_update_display(mwdevice, MW_SCREEN_MODE_IDLE, 1);
+       mw_free_pbuffer(mwbuf);
+}
+
 void mw_send_notify(mwdevice_t *mwdevice, char *header, char *body)
 {
        mw_buffer *mwbuf;
@@ -271,7 +397,13 @@ void test_application(mwdevice_t *mwdevice)
        unsigned char *bbuf;
        int len;
 
+       mw_enable_button(mwdevice, MW_SCREEN_MODE_IDLE, MW_BUTTON_A, MW_BUTTON_IMMEDIATE, MW_BUTTON_EVENT_MESSAGE, MW_BUTTON_A);
+
        mw_enable_button(mwdevice, MW_SCREEN_MODE_APPLICATION, MW_BUTTON_A, MW_BUTTON_IMMEDIATE, MW_BUTTON_EVENT_MESSAGE, MW_BUTTON_A);
+       mw_enable_button(mwdevice, MW_SCREEN_MODE_APPLICATION, MW_BUTTON_B, MW_BUTTON_IMMEDIATE, MW_BUTTON_EVENT_MESSAGE, MW_BUTTON_B);
+       mw_enable_button(mwdevice, MW_SCREEN_MODE_APPLICATION, MW_BUTTON_C, MW_BUTTON_IMMEDIATE, MW_BUTTON_EVENT_MESSAGE, MW_BUTTON_C);
+       mw_enable_button(mwdevice, MW_SCREEN_MODE_APPLICATION, MW_BUTTON_E, MW_BUTTON_IMMEDIATE, MW_BUTTON_EVENT_MESSAGE, MW_BUTTON_E);
+       mw_enable_button(mwdevice, MW_SCREEN_MODE_APPLICATION, MW_BUTTON_F, MW_BUTTON_IMMEDIATE, MW_BUTTON_EVENT_MESSAGE, MW_BUTTON_F);
        mw_configure_watch_mode(mwdevice, MW_SCREEN_MODE_APPLICATION, 0, 30, 0);
 
        mwbuf = mw_alloc_pbuffer(96, 96, 1);
@@ -294,11 +426,71 @@ void test_application(mwdevice_t *mwdevice)
        mw_free_pbuffer(mwbuf);
 }
 
+void draw_app_ana_clock(mwdevice_t *mwdevice, int hour, int minute, unsigned char day)
+{
+       mw_buffer *mwbuf;
+       unsigned char *bbuf;
+       char daystr[5];
+       int len;
+       unsigned int i, x, y, x2, y2;
+       double tmp, mf;
+
+       mw_enable_button(mwdevice, MW_SCREEN_MODE_IDLE, MW_BUTTON_A, MW_BUTTON_IMMEDIATE, MW_BUTTON_EVENT_MESSAGE, MW_BUTTON_A);
+
+       mw_enable_button(mwdevice, MW_SCREEN_MODE_APPLICATION, MW_BUTTON_A, MW_BUTTON_IMMEDIATE, MW_BUTTON_EVENT_MESSAGE, MW_BUTTON_A);
+       mw_enable_button(mwdevice, MW_SCREEN_MODE_APPLICATION, MW_BUTTON_B, MW_BUTTON_IMMEDIATE, MW_BUTTON_EVENT_MESSAGE, MW_BUTTON_B);
+       mw_enable_button(mwdevice, MW_SCREEN_MODE_APPLICATION, MW_BUTTON_C, MW_BUTTON_IMMEDIATE, MW_BUTTON_EVENT_MESSAGE, MW_BUTTON_C);
+       mw_enable_button(mwdevice, MW_SCREEN_MODE_APPLICATION, MW_BUTTON_E, MW_BUTTON_IMMEDIATE, MW_BUTTON_EVENT_MESSAGE, MW_BUTTON_E);
+       mw_enable_button(mwdevice, MW_SCREEN_MODE_APPLICATION, MW_BUTTON_F, MW_BUTTON_IMMEDIATE, MW_BUTTON_EVENT_MESSAGE, MW_BUTTON_F);
+       mw_configure_watch_mode(mwdevice, MW_SCREEN_MODE_APPLICATION, 0, 30, 0);
+
+       mwbuf = mw_alloc_pbuffer(96, 96, 1);
+       mw_buf_clear(mwbuf, MW_BLACK);
+
+       hour -= 3;
+       mf = (1. / 59.) * (double)minute;
+       minute -= 15;
+
+       // plot(R*cos(360° * i/N), R*sin(360° * i/N))
+       for (i=0; i<12; i++) {
+               tmp = 48. + (43. * cos(((2. * M_PI) / 12.) * (double)i));
+               x =  tmp;
+               tmp = 48 + (43. * sin(((2. * M_PI) / 12.) * (double)i));
+               y =  tmp;
+               tmp = 48. + (48. * cos(((2. * M_PI) / 12.) * (double)i));
+               x2 =  tmp;
+               tmp = 48 + (48. * sin(((2. * M_PI) / 12.) * (double)i));
+               y2 =  tmp;
+               mw_buf_draw_line_bresenham(mwbuf, x, y, x2, y2, MW_WHITE);
+       };
+       // Hour
+       g_print("hour = %d -> %f (%f)\n", hour, (double)hour + mf, mf);
+       tmp = 48. + (30. * cos(((2. * M_PI) / 12.) * ((double)hour + mf)));
+       x =  tmp;
+       tmp = 48 + (30. * sin(((2. * M_PI) / 12.) * ((double)hour + mf)));
+       y =  tmp;
+       mw_buf_draw_line_bresenham(mwbuf, 48, 48, x, y, MW_WHITE);
+       // Minute
+       tmp = 48. + (40. * cos(((2. * M_PI) / 60.) * (double)minute));
+       x =  tmp;
+       tmp = 48 + (40. * sin(((2. * M_PI) / 60.) * (double)minute));
+       y =  tmp;
+       mw_buf_draw_line_bresenham(mwbuf, 48, 48, x, y, MW_WHITE);
+
+       snprintf(daystr, 5, "%d", day);
+       mw_buf_print(mwbuf, 74, 45, daystr, 0, MW_WHITE, MW_BLACK);
+
+       bbuf = mw_make_mw_buffer(mwbuf, &len);
+       mw_send_bitmap(mwdevice, MW_SCREEN_MODE_APPLICATION, 96, 96, 0, bbuf, len);
+       mw_update_display(mwdevice, MW_SCREEN_MODE_APPLICATION, 1);
+       mw_free_pbuffer(mwbuf);
+}
+
 void test_oled(mwdevice_t *mwdevice, unsigned char oled)
 {
        mw_buffer *mwbuf;
        unsigned char *bbuf;
-       int len, i;
+       int len;
 
        mwbuf = mw_alloc_pbuffer(80, 16, 1);
        mw_buf_clear(mwbuf, MW_BLACK);
@@ -312,62 +504,162 @@ void test_oled(mwdevice_t *mwdevice, unsigned char oled)
        mw_free_pbuffer(mwbuf);
 }
 
+static void
+weather_soup_callback (SoupSession *session, SoupMessage *msg, gpointer user_data)
+{
+       xmlDocPtr xdoc;
+
+       /* Handle the response here */
+       if (msg->response_body->data != NULL && msg->response_body->length != 0) {
+               fprintf(stderr, "%s\n", msg->response_body->data);
+               xdoc = xmlReadMemory(msg->response_body->data, msg->response_body->length, "noname.xml", NULL, 0);
+               if (xdoc == NULL) {
+                       fprintf(stderr, "Failed to parse document\n");
+                       return;
+               }
+               xmlFreeDoc(xdoc);
+               xmlCleanupParser();
+       }
+}
+
+void do_weather(mwdata_t *mwdata)
+{
+       mwdata->msoup = soup_session_async_new();
+       mwdata->smsg = soup_message_new ("GET", "http://www.google.com/ig/api?weather=siegen&hl=de");
+       soup_session_send_message (mwdata->msoup, mwdata->smsg);
+       soup_session_queue_message (mwdata->msoup, mwdata->smsg, weather_soup_callback, mwdata);
+}
+
 void print_help(void)
 {
+       g_print("Not yet implemented..\n");
+}
+
+#define PARAMS_MAX 8
+#define PARAMS_LEN 16
+
+static int separate_params(char *params[], char *pbuf)
+{
+       char *ret;
+       char tbuf[128];
+       int cnt = 0;
+
+       memset(tbuf, 0, 128);
+       strncpy(tbuf, pbuf, strlen(pbuf));
+       // strdump(tbuf, strlen(tbuf));
+       /* we know we do have at least one parameter */
+       ret = strtok(tbuf, " ");
+       while (ret != NULL) {
+               // dbg_printf("tok '%s'\n", ret);
+               strncpy(params[cnt++], ret, PARAMS_LEN-1);
+               if (cnt > PARAMS_MAX)
+                       break;
+               ret = strtok(NULL, " ");
+       }
+
+       return cnt;
+}
+
+static void params_free(char **params)
+{
+       int i;
+       for (i=0; i < PARAMS_MAX; i++)
+               free(params[i]);
 }
 
 void process_cmd(char *cmdline, int clinep, mwdata_t *mwdata)
 {
        unsigned char mdata[32];
        unsigned int intopt;
+       char cmd[128], pbuf[128], *params[PARAMS_MAX];
+       int i, pcnt;
+       char *inbuf = cmdline;
+
+       g_print("command: '%s'\n", cmdline);
 
-       fprintf(stderr, "command: '%s'\n", cmdline);
+       for (i=0; i<PARAMS_MAX; i++) {
+               params[i] = malloc(PARAMS_LEN);
+               memset(params[i], 0, PARAMS_LEN);
+       }
+       memset(cmd, 0, 128);
+       memset(pbuf, 0, 128);
+       i = 0;
+       do {
+               char c;
+               c = *(inbuf++);
+               cmd[i++] = c;
+       } while (*inbuf != 0 && *inbuf != 0x20);
+       i = 0;
+       if (inbuf != NULL && *inbuf == 0x20) {
+               inbuf++;
+               do {
+                       pbuf[i++] = *(inbuf++);
+               } while (*inbuf != 0);
+       };
+       if (strlen(pbuf) > 0)
+               pcnt = separate_params(params, pbuf);
+       else
+               pcnt = 0;
 
-       if (strncmp(cmdline, "quit", 4) == 0) {
+       if (strncmp(cmd, "quit", 4) == 0) {
                //close(mw_fd);
                //exit(0);
+               /* just in case we quit and show another screen */
+               mw_update_display(&mwdata->mwdevice, MW_SCREEN_MODE_IDLE, 0);
+               params_free(params);
                g_main_loop_quit (mwdata->mloop);
        }
-       if (strncmp(cmdline, "help", 4) == 0) {
+       if (strncmp(cmd, "help", 4) == 0) {
                print_help();
        }
-       if (strncmp(cmdline, "ahand", 5) == 0) {
-               intopt = atoi(cmdline+5);
-               g_print("Advance analog hands by %d minutes\n", intopt);
-               mdata[0] = intopt / 60;
-               mdata[1] = intopt % 60;
-               mdata[2] = 0;
-               mw_send_frame(&mwdata->mwdevice, MW_ADVANCE_WATCH_HANDS, 0, mdata, 3);
+       if (strncmp(cmd, "ahand", 5) == 0) {
+               if (pcnt > 0) {
+                       intopt = atoi(params[0]); /*atoi(cmdline+5);*/
+                       g_print("Advance analog hands by %d minutes\n", intopt);
+                       mdata[0] = intopt / 60;
+                       mdata[1] = intopt % 60;
+                       mdata[2] = 0;
+                       mw_send_frame(&mwdata->mwdevice, MW_ADVANCE_WATCH_HANDS, 0, mdata, 3);
+               } else
+                       g_print("missing argument\n ahand # - # = no. of minutes\n");
        }
-       if (strncmp(cmdline, "srtc", 4) == 0) {
-               fprintf(stderr, "Setting RTC from system time...");
-               mw_set_rtc(&mwdata->mwdevice, MW_RTC_CLOCK_24HR, MW_RTC_DATE_DDMM);
-               fprintf(stderr, "OK\n");
+       if (strncmp(cmd, "srtc", 4) == 0) {
+               time_t mtime;
+               struct tm mtm;
+
+               mtime = time(NULL);
+               localtime_r(&mtime, &mtm);
+
+               g_print("Setting RTC from system time...");
+               mw_set_rtc(&mwdata->mwdevice, &mtm);
+               g_print("OK\n");
        }
-       if (strncmp(cmdline, "grtc", 4) == 0) {
+       if (strncmp(cmd, "grtc", 4) == 0) {
                mw_send_frame(&mwdata->mwdevice, MW_GET_REAL_TIME_CLOCK, 0, NULL, 0);
        }
-       if (strncmp(cmdline, "gistr", 5) == 0) {
-               intopt = cmdline[6]-0x30;
-               if (intopt>=0 && intopt <=3)
+       if (strncmp(cmd, "gistr", 5) == 0) {
+               if (pcnt > 0)
+                       intopt = atoi(params[0]);
+               if (intopt >= 0 && intopt <= 3)
                        mdata[0] = intopt;
                else
                        mdata[0] = 0;
                mw_send_frame(&mwdata->mwdevice, MW_GET_INFORMATION_STRING, 0, mdata, 1);
        }
-       if (strncmp(cmdline, "gdtype", 6) == 0) {
+       if (strncmp(cmd, "gdtype", 6) == 0) {
                mw_send_frame(&mwdata->mwdevice, MW_GET_DEVICE_TYPE, 0, NULL, 0);
        }
-       if (strncmp(cmdline, "rvbat", 5) == 0) {
+       if (strncmp(cmd, "rvbat", 5) == 0) {
                mw_send_frame(&mwdata->mwdevice, MW_READ_BATTERY_VOLTAGE_MSG, 0, NULL, 0);
        }
-       if (strncmp(cmdline, "rlight", 6) == 0) {
+       if (strncmp(cmd, "rlight", 6) == 0) {
                mw_send_frame(&mwdata->mwdevice, MW_READ_LIGHT_SENSOR_MSG, 0, NULL, 0);
        }
-       if (strncmp(cmdline, "modecfg", 6) == 0) {
+       if (strncmp(cmd, "modecfg", 6) == 0) {
                mw_configure_watch_mode(&mwdata->mwdevice, MW_SCREEN_MODE_IDLE, 0, 4, 1);
                mw_update_display(&mwdata->mwdevice, MW_SCREEN_MODE_IDLE, 0);
        }
+#if 0
        if (strncmp(cmdline, "rbtcfg", 6) == 0) {
                intopt = cmdline[7]-0x30;
                mdata[0] = 0; /* idle screen */
@@ -378,43 +670,77 @@ void process_cmd(char *cmdline, int clinep, mwdata_t *mwdata)
                mdata[4] = 0; /* callback message option */
                mw_send_frame(&mwdata->mwdevice, MW_READ_BUTTON_CONFIG, 0, mdata, 5);
        }
-       if (strncmp(cmdline, "svib", 4) == 0) {
+#endif
+       if (strncmp(cmd, "svib", 4) == 0) {
                mw_set_vibrate_mode(&mwdata->mwdevice, 1, 300, 300, 5);
        }
-       if (strncmp(cmdline, "tbmp", 4) == 0) {
+       if (strncmp(cmd, "tbmp", 4) == 0) {
                bitmap_test(&mwdata->mwdevice);
        }
-       if (strncmp(cmdline, "t2bmp", 5) == 0) {
+       if (strncmp(cmd, "t2bmp", 5) == 0) {
                bitmap_test2(&mwdata->mwdevice);
        }
-       if (strncmp(cmdline, "text", 4) == 0) {
+       if (strncmp(cmd, "text", 4) == 0) {
                text_test(&mwdata->mwdevice);
        }
-       if (strncmp(cmdline, "tline", 5) == 0) {
+       if (strncmp(cmd, "tline", 5) == 0) {
                line_test(&mwdata->mwdevice);
        }
-       if (strncmp(cmdline, "rbmp", 4) == 0) {
+       if (strncmp(cmd, "rbmp", 4) == 0) {
                bitmap_read(&mwdata->mwdevice);
        }
-       if (strncmp(cmdline, "tnote", 5) == 0) {
-               test_notification(&mwdata->mwdevice);
+       if (strncmp(cmd, "tnote", 5) == 0) {
+               // test_notification(&mwdata->mwdevice);
+               mw_do_notification(&mwdata->mwdevice, "TestNotification", "This is a pretty long text that needs to be broken and torn", 1);
        }
-       if (strncmp(cmdline, "tapp", 4) == 0) {
+       if (strncmp(cmd, "tapp", 4) == 0) {
                test_application(&mwdata->mwdevice);
        }
-       if (strncmp(cmdline, "eoled", 5) == 0) {
-               intopt = cmdline[6]-0x30;
-               if (intopt == MW_OLED_UPPER || intopt == MW_OLED_LOWER)
-                       mw_send_frame(&mwdata->mwdevice, MW_ENABLE_OLED_DISPLAY_MSG, intopt, NULL, 0);
+       if (strncmp(cmd, "eoled", 5) == 0) {
+               if (pcnt > 0) {
+                       intopt = atoi(params[0]);
+                       if (intopt == MW_OLED_UPPER || intopt == MW_OLED_LOWER)
+                               mw_send_frame(&mwdata->mwdevice, MW_ENABLE_OLED_DISPLAY_MSG, intopt, NULL, 0);
+               }
        }
-       if (strncmp(cmdline, "toled", 5) == 0) {
-               intopt = cmdline[6]-0x30;
+       if (strncmp(cmd, "toled", 5) == 0) {
+               intopt = atoi(params[0]);
                test_oled(&mwdata->mwdevice, intopt);
                //mw_write_oled_buffer(mwdevice, 0, 80, 0, mdata, 10);
                //mw_send_frame(mwdevice, MW_UPDATE_OLED_DISPLAY_MSG, 0, NULL, 0);
        }
-}
+       if (strncmp(cmd, "cal", 3) == 0) {
+               draw_idle_calendar(&mwdata->mwdevice);
+       }
+       if (strncmp(cmd, "wet", 3) == 0) {
+               do_weather(mwdata);
+       }
+       if (strncmp(cmd, "c24", 3) == 0) {
+               mdata[0] = MW_RTC_CLOCK_24HR;
+               mw_nval_operation(&mwdata->mwdevice, MW_NVAL_OPERATION_WRITE, MW_NVAL_TIME_FORMAT, 1, mdata);
+       }
+       if (strncmp(cmd, "g24", 3) == 0) {
+               mdata[0] = 0;
+               mw_nval_operation(&mwdata->mwdevice, MW_NVAL_OPERATION_READ, MW_NVAL_TIME_FORMAT, 1, mdata);
+       }
+       if (strncmp(cmd, "sdm", 3) == 0) {
+               mdata[0] = MW_RTC_DATE_DDMM;
+               mw_nval_operation(&mwdata->mwdevice, MW_NVAL_OPERATION_WRITE, MW_NVAL_DATE_FORMAT, 1, mdata);
+       }
+       if (strncmp(cmd, "gdm", 3) == 0) {
+               mdata[0] = 0;
+               mw_nval_operation(&mwdata->mwdevice, MW_NVAL_OPERATION_READ, MW_NVAL_DATE_FORMAT, 1, mdata);
+       }
+       if (strncmp(cmd, "dana", 4) == 0) {
+               if (pcnt < 3)
+                       g_print("two few params, hour minute\n");
+               else {
+                       draw_app_ana_clock(&mwdata->mwdevice, atoi(params[0]), atoi(params[1]), atoi(params[2]));
+               }
+       }
 
+       params_free(params);
+}
 
 int feed_menu(mwdata_t *mdata)
 {
@@ -439,127 +765,13 @@ int feed_menu(mwdata_t *mdata)
        return 0;
 }
 
-int open_socket(bdaddr_t *bdaddr, uint8_t channel)
-{
-       struct sockaddr_rc addr;
-       int sk, opt;
-       //int f;
-
-       sk = socket(PF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM);
-       if (sk < 0) {
-               fprintf(stderr, "Can't create socket: %s (%d)\n",
-                       strerror(errno), errno);
-                return -1;
-        }
-
-/*
-        f = 1;
-        if (setsockopt(sk, SOL_BLUETOOTH, BT_FLUSHABLE, &f, sizeof(f)) < 0) {
-               fprintf(stderr, "Can't set flushable: %s (%d)\n",
-                       strerror(errno), errno);
-               return -1;
-        }
-*/
-        memset(&addr, 0, sizeof(addr));
-        addr.rc_family = AF_BLUETOOTH;
-        bacpy(&addr.rc_bdaddr, BDADDR_ANY);
-
-        if (bind(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
-                fprintf(stderr, "Can't bind socket: %s (%d)\n",
-                                                        strerror(errno), errno);
-                close(sk);
-                return -1;
-        }
-
-       /* Set link mode */
-        opt = 0;
-        opt |= RFCOMM_LM_MASTER;
-        opt |= RFCOMM_LM_AUTH;
-/*
-        opt |= RFCOMM_LM_ENCRYPT;
-        opt |= RFCOMM_LM_SECURE;
-*/
-        if (opt && setsockopt(sk, SOL_RFCOMM, RFCOMM_LM, &opt, sizeof(opt)) < 0) {
-                fprintf(stderr, "Can't set RFCOMM link mode: %s (%d)",
-                                                        strerror(errno), errno);
-                close(sk);
-                return -1;
-        }
-
-        memset(&addr, 0, sizeof(addr));
-        addr.rc_family = AF_BLUETOOTH;
-        bacpy(&addr.rc_bdaddr, bdaddr);
-        addr.rc_channel = channel;
-
-        if (connect(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
-                fprintf(stderr, "Can't connect: %s (%d)\n",
-                                                        strerror(errno), errno);
-                close(sk);
-                return -1;
-        }
-
-        return sk;
-}
-
-void baswap(bdaddr_t *dst, const bdaddr_t *src)
-{
-        register unsigned char *d = (unsigned char *) dst;
-        register const unsigned char *s = (const unsigned char *) src;
-        register int i;
-
-        for (i = 0; i < 6; i++)
-                d[i] = s[5-i];
-}
-
-int bachk(const char *str)
-{
-        if (!str)
-                return -1;
-
-        if (strlen(str) != 17)
-                return -1;
-
-        while (*str) {
-                if (!isxdigit(*str++))
-                        return -1;
-
-                if (!isxdigit(*str++))
-                        return -1;
-
-                if (*str == 0)
-                        break;
-
-                if (*str++ != ':')
-                        return -1;
-        }
-
-        return 0;
-}
-
-int str2ba(const char *str, bdaddr_t *ba)
-{
-        bdaddr_t b;
-        int i;
-
-        if (bachk(str) < 0) {
-                memset(ba, 0, sizeof(*ba));
-                return -1;
-        }
-
-        for (i = 0; i < 6; i++, str += 3)
-                b.b[i] = strtol(str, NULL, 16);
-
-        baswap(ba, &b);
-
-        return 0;
-}
 
 gboolean handle_mw_io(GIOChannel *mw_io, GIOCondition condition, gpointer udata)
 {
        mwdata_t *mdata = (mwdata_t *)udata;
        int rcvd;
 
-       rcvd = read(mdata->mwdevice.mw_fd, mdata->rcvbuf+mdata->rcvbuf_pos, 64);
+       rcvd = read(mdata->mwdevice.mw_fd, mdata->rcvbuf, 64);
 #ifdef DEBUG
        fprintf(stderr, "read %d bytes:\n", rcvd);
 #endif
@@ -567,8 +779,7 @@ gboolean handle_mw_io(GIOChannel *mw_io, GIOCondition condition, gpointer udata)
 #ifdef DEBUG
                dump_frame(mdata->rcvbuf, rcvd);
 #endif
-               decode_frame(&mdata->mwdevice, mdata->rcvbuf, rcvd);
-               mdata->rcvbuf_pos = 0;
+               mw_feed_msg_buffer(&mdata->mwdevice, mdata->rcvbuf, rcvd);
        }
 
        return TRUE;
@@ -629,6 +840,20 @@ signal_filter (DBusConnection *connection, DBusMessage *message, void *user_data
        return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
 }
 
+void mw_button_event_message_cb(mwdevice_t *mwdevice, unsigned char buttons, unsigned char options, void *user_data)
+{
+       g_print("button event cb:0x%02x 0x%02x\n", buttons, options);
+       g_print("screen is %d\n", mwdevice->screen_mode);
+       if (mwdevice->screen_mode == MW_SCREEN_MODE_IDLE) {
+               if (buttons == MW_BUTTON_A)
+                       test_application(mwdevice);
+       }
+       if (mwdevice->screen_mode == MW_SCREEN_MODE_APPLICATION) {
+               if (buttons == MW_BUTTON_C)
+                       mw_update_display(mwdevice, MW_SCREEN_MODE_IDLE, 0);
+       }
+}
+
 int main(int argc, char **argv)
 {
        int mw_fd;
@@ -710,6 +935,9 @@ int main(int argc, char **argv)
        memset(mdata.cmdline, 0, 128);
        mdata.cmdline_pos = 0;
 
+       mw_init(&mdata.mwdevice, mw_fd);
+       mw_set_button_event_message_cb(&mdata.mwdevice, mw_button_event_message_cb, NULL);
+
        g_main_loop_run (mdata.mloop);
 
        fsync(mw_fd);