WIP: Support utf8 text coming from Gadgetbridge.

jakkra · Oct 30, 2023 · ec0bc39 · ec0bc39
1 parent 4a4bacb
commit ec0bc39
Show file tree

Hide file tree

Showing 3 changed files with 1,198 additions and 4 deletions.
diff --git a/app/src/ble/ble_comm.c b/app/src/ble/ble_comm.c
@@ -522,10 +522,175 @@ static int32_t extract_value_int32(char *key, char *data)
     return id;
 }
 
+static uint8_t basic_latin_utf16_to_utf8_table[128][3] =  {
+{0x80, 0xc2, 0x80},
+{0x81, 0xc2, 0x81},
+{0x82, 0xc2, 0x82},
+{0x83, 0xc2, 0x83},
+{0x84, 0xc2, 0x84},
+{0x85, 0xc2, 0x85},
+{0x86, 0xc2, 0x86},
+{0x87, 0xc2, 0x87},
+{0x88, 0xc2, 0x88},
+{0x89, 0xc2, 0x89},
+{0x8A, 0xc2, 0x8a},
+{0x8B, 0xc2, 0x8b},
+{0x8C, 0xc2, 0x8c},
+{0x8D, 0xc2, 0x8d},
+{0x8E, 0xc2, 0x8e},
+{0x8F, 0xc2, 0x8f},
+{0x90, 0xc2, 0x90},
+{0x91, 0xc2, 0x91},
+{0x92, 0xc2, 0x92},
+{0x93, 0xc2, 0x93},
+{0x94, 0xc2, 0x94},
+{0x95, 0xc2, 0x95},
+{0x96, 0xc2, 0x96},
+{0x97, 0xc2, 0x97},
+{0x98, 0xc2, 0x98},
+{0x99, 0xc2, 0x99},
+{0x9A, 0xc2, 0x9a},
+{0x9B, 0xc2, 0x9b},
+{0x9C, 0xc2, 0x9c},
+{0x9D, 0xc2, 0x9d},
+{0x9E, 0xc2, 0x9e},
+{0x9F, 0xc2, 0x9f},
+{0xA0, 0xc2, 0xa0},
+{0xA1, 0xc2, 0xa1},
+{0xA2, 0xc2, 0xa2},
+{0xA3, 0xc2, 0xa3},
+{0xA4, 0xc2, 0xa4},
+{0xA5, 0xc2, 0xa5},
+{0xA6, 0xc2, 0xa6},
+{0xA7, 0xc2, 0xa7},
+{0xA8, 0xc2, 0xa8},
+{0xA9, 0xc2, 0xa9},
+{0xAA, 0xc2, 0xaa},
+{0xAB, 0xc2, 0xab},
+{0xAC, 0xc2, 0xac},
+{0xAD, 0xc2, 0xad},
+{0xAE, 0xc2, 0xae},
+{0xAF, 0xc2, 0xaf},
+{0xB0, 0xc2, 0xb0},
+{0xB1, 0xc2, 0xb1},
+{0xB2, 0xc2, 0xb2},
+{0xB3, 0xc2, 0xb3},
+{0xB4, 0xc2, 0xb4},
+{0xB5, 0xc2, 0xb5},
+{0xB6, 0xc2, 0xb6},
+{0xB7, 0xc2, 0xb7},
+{0xB8, 0xc2, 0xb8},
+{0xB9, 0xc2, 0xb9},
+{0xBA, 0xc2, 0xba},
+{0xBB, 0xc2, 0xbb},
+{0xBC, 0xc2, 0xbc},
+{0xBD, 0xc2, 0xbd},
+{0xBE, 0xc2, 0xbe},
+{0xBF, 0xc2, 0xbf},
+{0xC0, 0xc3, 0x80},
+{0xC1, 0xc3, 0x81},
+{0xC2, 0xc3, 0x82},
+{0xC3, 0xc3, 0x83},
+{0xC4, 0xc3, 0x84},
+{0xC5, 0xc3, 0x85},
+{0xC6, 0xc3, 0x86},
+{0xC7, 0xc3, 0x87},
+{0xC8, 0xc3, 0x88},
+{0xC9, 0xc3, 0x89},
+{0xCA, 0xc3, 0x8a},
+{0xCB, 0xc3, 0x8b},
+{0xCC, 0xc3, 0x8c},
+{0xCD, 0xc3, 0x8d},
+{0xCE, 0xc3, 0x8e},
+{0xCF, 0xc3, 0x8f},
+{0xD0, 0xc3, 0x90},
+{0xD1, 0xc3, 0x91},
+{0xD2, 0xc3, 0x92},
+{0xD3, 0xc3, 0x93},
+{0xD4, 0xc3, 0x94},
+{0xD5, 0xc3, 0x95},
+{0xD6, 0xc3, 0x96},
+{0xD7, 0xc3, 0x97},
+{0xD8, 0xc3, 0x98},
+{0xD9, 0xc3, 0x99},
+{0xDA, 0xc3, 0x9a},
+{0xDB, 0xc3, 0x9b},
+{0xDC, 0xc3, 0x9c},
+{0xDD, 0xc3, 0x9d},
+{0xDE, 0xc3, 0x9e},
+{0xDF, 0xc3, 0x9f},
+{0xE0, 0xc3, 0xa0},
+{0xE1, 0xc3, 0xa1},
+{0xE2, 0xc3, 0xa2},
+{0xE3, 0xc3, 0xa3},
+{0xE4, 0xc3, 0xa4},
+{0xE5, 0xc3, 0xa5},
+{0xE6, 0xc3, 0xa6},
+{0xE7, 0xc3, 0xa7},
+{0xE8, 0xc3, 0xa8},
+{0xE9, 0xc3, 0xa9},
+{0xEA, 0xc3, 0xaa},
+{0xEB, 0xc3, 0xab},
+{0xEC, 0xc3, 0xac},
+{0xED, 0xc3, 0xad},
+{0xEE, 0xc3, 0xae},
+{0xEF, 0xc3, 0xaf},
+{0xF0, 0xc3, 0xb0},
+{0xF1, 0xc3, 0xb1},
+{0xF2, 0xc3, 0xb2},
+{0xF3, 0xc3, 0xb3},
+{0xF4, 0xc3, 0xb4},
+{0xF5, 0xc3, 0xb5},
+{0xF6, 0xc3, 0xb6},
+{0xF7, 0xc3, 0xb7},
+{0xF8, 0xc3, 0xb8},
+{0xF9, 0xc3, 0xb9},
+{0xFA, 0xc3, 0xba},
+{0xFB, 0xc3, 0xbb},
+{0xFC, 0xc3, 0xbc},
+{0xFD, 0xc3, 0xbd},
+{0xFE, 0xc3, 0xbe},
+{0xFF, 0xc3, 0xbf},
+};
+
+static char* parse_and_convert_to_utf8(char* data, int len)
+{
+    int i = 0, j = 0;
+    char output[100];
+    memset(output, 0, sizeof(output));
+    while (data[i] != '\0' && i < len - 3) {
+        if (data[i] == '\\' && data[i+1] == 'x') {
+            char hex[3] = {data[i+2], data[i+3], '\0'};
+            int value = strtol(hex, NULL, 16);
+            if (value < 0x80) {
+                data[j] = value;
+            } else {
+                data[j] = basic_latin_utf16_to_utf8_table[value - 0x80][1];
+                j++;
+                data[j] = basic_latin_utf16_to_utf8_table[value - 0x80][2];
+                j++;
+            }
+            i += 4;
+        } else {
+            char tmp = data[i];
+            data[j] = tmp;
+            //data[j] = data[i];
+            i++;
+            j++;
+        }
+    }
+
+    data[j] = '\0';
+    return data;
+}
+
 static int parse_notify(char *data, int len)
 {
     ble_comm_cb_data_t cb;
     memset(&cb, 0, sizeof(cb));
+    char * asdf = "w\xc4q";
+
+    data = parse_and_convert_to_utf8(data, len);
 
     cb.type = BLE_COMM_DATA_TYPE_NOTIFY;
     cb.data.notify.id = extract_value_uint32("\"id\":", data);