map-agent/map_bmessage.c

   1 /*
   2  * Bluetooth-agent
   3  *
   4  * Copyright (c) 2000 - 2011 Samsung Electronics Co., Ltd. All rights reserved.
   5  *
   6  * Contact:  Hocheol Seo <hocheol.seo@samsung.com>
   7  *               Girishashok Joshi <girish.joshi@samsung.com>
   8  *               Chanyeol Park <chanyeol.park@samsung.com>
   9  *
  10  * Licensed under the Apache License, Version 2.0 (the "License");
  11  * you may not use this file except in compliance with the License.
  12  * You may obtain a copy of the License at
  13  *
  14  *              http://www.apache.org/licenses/LICENSE-2.0
  15  *
  16  * Unless required by applicable law or agreed to in writing, software
  17  * distributed under the License is distributed on an "AS IS" BASIS,
  18  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  19  * See the License for the specific language governing permissions and
  20  * limitations under the License.
  21  *
  22  */
  23
  24 #include <stdio.h>
  25 #include <string.h>
  26 #include <glib.h>
  27
  28 #include <ITapiNetText.h>
  29
  30 #include <map_bmessage.h>
  31 #include <bluetooth_map_agent.h>
  32
  33 #define CRLF_LEN 2
  34 #define BT_SMS_DATA_MAX_LEN 165
  35
  36 #define BMSG_TAG "BEGIN:BMSG\r\n"
  37 #define VER_TAG "VERSION:"
  38 #define STATUS_TAG "STATUS:"
  39 #define TYPE_TAG "TYPE:"
  40 #define FOLDER_TAG "FOLDER:"
  41 #define VCARD_BEGIN_TAG "BEGIN:VCARD\r\n"
  42 #define VCARD_END_TAG "END:VCARD\r\n"
  43 #define VCARD_N_TAG "N:"
  44 #define VCARD_FN_TAG "FN:"
  45 #define VCARD_TEL_TAG "TEL:"
  46 #define VCARD_EMAIL_TAG "EMAIL:"
  47 #define BENV_TAG "BEGIN:BENV\r\n"
  48 #define BBODY_TAG "BEGIN:BBODY\r\n"
  49 #define MSG_TAG "BEGIN:MSG\r\n"
  50 #define PARTID_TAG "PARTID:"
  51 #define ENCODING_TAG "ENCODING:"
  52 #define CHARSET_TAG "CHARSET:"
  53 #define LANGUAGE_TAG "LANGUAGE:"
  54 #define LENGTH_TAG "LENGTH:"
  55
  56 static guint8 g_enc_lvl = 1;
  57
  58 void print_bmsg(struct bmsg_data *bmsg)
  59 {
  60         FN_START;
  61         if (bmsg == NULL)
  62                 return;
  63
  64         struct benv_data *env_data = NULL;
  65
  66         DBG("bmsg->version = %s", bmsg->version);
  67         DBG("bmsg->status = %s", bmsg->status);
  68         DBG("bmsg->type = %s", bmsg->type);
  69         DBG_SECURE("bmsg->folder = %s", bmsg->folder);
  70
  71         if (bmsg->originator_vcard_data) {
  72                 DBG_SECURE("bmsg->originator_vcard_data->version = %s",
  73                                                 bmsg->originator_vcard_data->version);
  74                 DBG_SECURE("bmsg->originator_vcard_data->n = %s",
  75                                                 bmsg->originator_vcard_data->n);
  76         }
  77
  78         int i = 0;
  79         env_data = g_slist_nth_data(bmsg->envelope_data->env_data, i);
  80         while (env_data != NULL) {
  81
  82                 DBG("env_data = %d", env_data->encapsulation_level);
  83                 int k = 0;
  84                 struct bmsg_vcard *rvcard;
  85
  86                 rvcard = g_slist_nth_data(env_data->recipient_vcard, k);
  87
  88                 while (rvcard != NULL) {
  89                         k++;
  90
  91                         if (rvcard->version != NULL)
  92                                 DBG("vcard->version = %s\n", rvcard->version);
  93                         if (rvcard->n != NULL)
  94                                 DBG_SECURE("vcard->n = %s\n", rvcard->n);
  95                         if (rvcard->fn != NULL)
  96                                 DBG_SECURE("vcard->fn = %s\n", rvcard->fn);
  97                         if (rvcard->tel != NULL)
  98                                 DBG_SECURE("vcard->tel = %s\n", rvcard->tel);
  99                         if (rvcard->email != NULL)
 100                                 DBG_SECURE("vcard->email = %s\n", rvcard->email);
 101
 102                         rvcard = g_slist_nth_data(env_data->recipient_vcard, k);
 103                 }
 104
 105                 if (env_data->body_content != NULL) {
 106                         DBG_SECURE("env_data->body_content->length = %"
 107                                                 G_GUINT64_FORMAT "\n",
 108                                                 env_data->body_content->length);
 109                         DBG_SECURE("env_data->body_content->msg = %s\n",
 110                                                 env_data->body_content->msg);
 111                 }
 112
 113                 i++;
 114
 115                 if (i > 2)
 116                         break;
 117
 118                 env_data = g_slist_nth_data(bmsg->envelope_data->env_data, i);
 119         }
 120         FN_END;
 121 }
 122
 123 static gchar *__bt_unpack_gsm7bit_msg(const char* pdu, int in_len)
 124 {
 125         FN_START;
 126         int i;
 127         int pos = 0;
 128         int shift = 0;
 129         gchar data[BT_SMS_DATA_MAX_LEN + 1] = {0,};
 130
 131         for (i = 0; i < in_len; i++) {
 132                 if (shift == 0) {
 133                         data[i] = pdu[pos] & 0x7F;
 134
 135                         shift = 7;
 136                         pos++;
 137                 } else {
 138                         data[i] = (pdu[pos - 1] >> shift) |
 139                                                 (pdu[pos] << (8 - shift));
 140                         data[i] &= 0x7F;
 141
 142                         shift--;
 143                         if (shift > 0)
 144                                 pos++;
 145                 }
 146         }
 147
 148         DBG_SECURE("msg = %s\n", data);
 149         FN_END;
 150         return g_strdup(data);
 151 }
 152
 153 static gchar *__bt_get_msg_body_from_pdu(gchar *pdu, guint64 pdu_len)
 154 {
 155         FN_START;
 156         int index = 0;
 157         int i;
 158         int j = 0;
 159         int dcs;
 160         int udh = 0;
 161         int coding_scheme;
 162         int phone_num_len = 0;
 163         char temp[3];
 164         char msg_data[BT_SMS_DATA_MAX_LEN + 1] = {0,};
 165         unsigned char pdu_data[TAPI_NETTEXT_MSG_SIZE_MAX] = {0,};
 166
 167         for (i = 0; i < (pdu_len - 1);) {
 168                 snprintf(temp, sizeof(temp), "%c%c", pdu[i], pdu[i+1]);
 169
 170                 pdu_data[j] = g_ascii_strtoull(temp, NULL, 16);
 171                 DBG("pdu_data = %02x\n", pdu_data[j]);
 172                 j++;
 173                 i = i + 2;
 174         }
 175
 176         DBG("pdu[%d] = %x\n", index, pdu_data[index]);
 177         if (pdu[index] == 0x00)
 178                 index++;
 179         else
 180                 index = index + pdu_data[index];
 181
 182         /* TP-MTI */
 183         index = index + 1;
 184
 185         if (pdu_data[index] & 0x40)
 186                 udh = 1;
 187
 188         DBG("udh = %d", udh);
 189
 190         /* TP-MR */
 191         index = index + 1;
 192
 193         /* phone number length */
 194         index = index + 1;
 195         DBG("pdu[%d] = %x\n", index, pdu_data[index]);
 196
 197         if ((pdu_data[index] % 2) == 0)
 198                 phone_num_len = pdu_data[index] / 2;
 199         else
 200                 phone_num_len = pdu_data[index] / 2 + 1;
 201
 202         DBG("phone_num_len [%d]\n", phone_num_len);
 203
 204         /* phone number type */
 205         index = index + 1;
 206
 207         /* phone_num_len/2 encoded phone num length */
 208         index = index + phone_num_len;
 209
 210         /* TP-PID */
 211         index = index + 1;
 212
 213         /* TP-DCS */
 214         index = index + 1;
 215
 216         dcs = pdu_data[index];
 217         coding_scheme = (dcs & 0x0C) >> 2;
 218         DBG("coding_scheme = %d\n", coding_scheme);
 219
 220         /* TP-VP */
 221         index = index + 1;
 222
 223         /* TP-UDL */
 224         index = index + 1;
 225         int udl = pdu_data[index];
 226         DBG("udl = %x\n", udl);
 227
 228         /* message body */
 229         index = index + 1;
 230
 231         memcpy(msg_data, (void*)&pdu_data[index], udl);
 232
 233         FN_END;
 234         return __bt_unpack_gsm7bit_msg(msg_data, udl);
 235 }
 236
 237 static gchar *__bt_get_valid_number(gchar* num)
 238 {
 239         FN_START;
 240         int len;
 241         int i = 0;
 242         int j = 0;
 243         gchar *valid_num;
 244
 245         if (!num)
 246                 return NULL;
 247
 248         len = strlen(num);
 249
 250         valid_num = g_malloc0(len + 1);
 251         retv_if(valid_num == NULL, NULL);
 252
 253         for (i = 0, j = 0; i < len; i++) {
 254
 255                 if (num[i] != '-') {
 256                         valid_num[j] = num[i];
 257                         j++;
 258                 }
 259         }
 260
 261         valid_num[j] = '\0';
 262
 263         FN_END;
 264         return valid_num;
 265 }
 266
 267 char *bmsg_get_msg_folder(struct bmsg_data *bmsg)
 268 {
 269         FN_START;
 270         return g_strdup(bmsg->folder);
 271 }
 272
 273 char *bmsg_get_msg_body(struct bmsg_data *bmsg, gboolean utf)
 274 {
 275         FN_START;
 276         struct benv_data *env_data;
 277         int i = 0;
 278
 279         env_data = g_slist_nth_data(bmsg->envelope_data->env_data, i);
 280
 281         while (env_data != NULL) {
 282                 if (env_data->body_content != NULL) {
 283                         DBG_SECURE("env_data->body_content->msg = %s\n",
 284                                                 env_data->body_content->msg);
 285                         DBG_SECURE("env_data->body_content->length = %"
 286                                                 G_GUINT64_FORMAT "\n",
 287                                                 env_data->body_content->length);
 288
 289                         if (utf == FALSE) {
 290                                 return __bt_get_msg_body_from_pdu(
 291                                                 env_data->body_content->msg,
 292                                                 env_data->body_content->length);
 293                         } else {
 294                                 return g_strndup(
 295                                                 env_data->body_content->msg,
 296                                                 env_data->body_content->length);
 297                         }
 298                 }
 299
 300                 i++;
 301                 if (i > 2)
 302                         break;
 303
 304                 env_data = g_slist_nth_data(bmsg->envelope_data->env_data, i);
 305         }
 306
 307         FN_END;
 308         return NULL;
 309 }
 310
 311 GSList *bmsg_get_msg_recepients(struct bmsg_data *bmsg)
 312 {
 313         FN_START;
 314         struct benv_data *env_data;
 315         GSList *receiver = NULL;
 316         int i = 0;
 317
 318         env_data = g_slist_nth_data(bmsg->envelope_data->env_data, i);
 319
 320         while (env_data != NULL) {
 321
 322                 DBG("env_data = %d", env_data->encapsulation_level);
 323                 int k = 0;
 324                 struct bmsg_vcard *rvcard;
 325
 326                 rvcard = g_slist_nth_data(env_data->recipient_vcard, k);
 327                 while (rvcard != NULL) {
 328                         k++;
 329
 330                         if (rvcard->tel != NULL) {
 331                                 DBG_SECURE("vcard->tel = %s\n", rvcard->tel);
 332                                 receiver = g_slist_append(receiver,
 333                                                                 rvcard->tel);
 334                         }
 335
 336                         rvcard = g_slist_nth_data(env_data->recipient_vcard, k);
 337                 }
 338
 339                 i++;
 340                 if (i > 2)
 341                         break;
 342
 343                 env_data = g_slist_nth_data(bmsg->envelope_data->env_data, i);
 344         }
 345         FN_END;
 346         return receiver;
 347 }
 348
 349 void bmsg_free_vcard_data(struct bmsg_vcard *vcard_data)
 350 {
 351         FN_START;
 352         if (vcard_data == NULL)
 353                 return;
 354
 355         g_free(vcard_data->version);
 356         g_free(vcard_data->n);
 357         g_free(vcard_data->fn);
 358         g_free(vcard_data->tel);
 359         g_free(vcard_data->email);
 360         g_free(vcard_data);
 361         FN_END;
 362         return;
 363 }
 364
 365 void bmsg_free_bmsg(struct bmsg_data *bmsg)
 366 {
 367         FN_START;
 368         struct benv_data *env_data;
 369         int i = 0;
 370
 371         if (bmsg == NULL)
 372                 return;
 373
 374         g_free(bmsg->version);
 375         g_free(bmsg->status);
 376         g_free(bmsg->type);
 377         g_free(bmsg->folder);
 378         bmsg_free_vcard_data(bmsg->originator_vcard_data);
 379
 380         if (bmsg->envelope_data == NULL)
 381                 goto done;
 382
 383         if (bmsg->envelope_data->env_data == NULL)
 384                 goto done;
 385
 386         env_data = g_slist_nth_data(bmsg->envelope_data->env_data, i);
 387         while (env_data != NULL) {
 388
 389                 DBG("env_data = %d", env_data->encapsulation_level);
 390                 int k = 0;
 391                 struct bmsg_vcard *rvcard;
 392
 393                 rvcard = g_slist_nth_data(env_data->recipient_vcard, k);
 394
 395                 while (rvcard != NULL) {
 396                         k++;
 397                         bmsg_free_vcard_data(rvcard);
 398                         rvcard = g_slist_nth_data(env_data->recipient_vcard, k);
 399                 }
 400
 401                 if (env_data->body_content != NULL) {
 402                         g_free(env_data->body_content->encoding);
 403                         g_free(env_data->body_content->charset);
 404                         g_free(env_data->body_content->language);
 405                         g_free(env_data->body_content->msg);
 406                         g_free(env_data->body_content);
 407                 }
 408
 409                 g_free(env_data);
 410                 i++;
 411
 412                 env_data = g_slist_nth_data(bmsg->envelope_data->env_data, i);
 413         }
 414
 415         FN_END;
 416 done:
 417         g_free(bmsg);
 418 }
 419
 420 gchar *bmsg_get_parse_sub_block(char **sub_block_data, char *element)
 421 {
 422         FN_START;
 423         gchar *start;
 424         gchar *end;
 425         gchar *block_start;
 426         gchar *block_end;
 427         gchar *sub_block = NULL;
 428         size_t offset;
 429         size_t len;
 430
 431         start = g_strdup_printf("BEGIN:%s\r\n", element);
 432         end = g_strdup_printf("END:%s\r\n", element);
 433         offset = strlen(start);
 434
 435         block_start = g_strstr_len(*sub_block_data, offset, start);
 436         if (block_start == NULL)
 437                 goto done;
 438
 439         if (!g_strcmp0(start, VCARD_BEGIN_TAG))
 440                 block_end = g_strstr_len(*sub_block_data, -1,  end);
 441         else
 442                 block_end = g_strrstr(*sub_block_data, end);
 443
 444         if (block_end == NULL)
 445                 goto done;
 446
 447         len = block_end - block_start - offset;
 448         sub_block = g_strndup(block_start + offset, len);
 449         *sub_block_data = *sub_block_data + strlen(sub_block) + strlen(start) +
 450                                                                  strlen(end);
 451 done:
 452         g_free(start);
 453         g_free(end);
 454         FN_END;
 455         return sub_block;
 456 }
 457
 458 gchar *bmsg_get_tag_data(char **block_data, char *element)
 459 {
 460         FN_START;
 461         gchar *end = "\r\n";
 462         gchar *block_start;
 463         gchar *block_end;
 464         gchar *sub_block;
 465         size_t offset;
 466         size_t len;
 467
 468         if (*block_data == NULL || element == NULL)
 469                 return NULL;
 470
 471         block_start = g_strstr_len(*block_data, -1, element);
 472         if (block_start == NULL)
 473                 return NULL;
 474
 475         offset = strlen(element);
 476
 477         block_end = g_strstr_len(block_start+offset, -1, end);
 478         if (block_end == NULL)
 479                 return NULL;
 480
 481         len = block_end - block_start - offset;
 482         sub_block = g_strndup(block_start + offset, len);
 483         *block_data = *block_data + offset + len + CRLF_LEN;
 484         FN_END;
 485         return sub_block;
 486 }
 487
 488 struct bmsg_bbody *bmsg_get_bbody_data(gchar *block_data)
 489 {
 490         FN_START;
 491         struct bmsg_bbody *bbody;
 492         gchar *temp;
 493         gchar *bbody_block_data_start = block_data;
 494
 495         bbody = g_new0(struct bmsg_bbody, 1);
 496
 497         temp = bmsg_get_tag_data(&block_data, PARTID_TAG);
 498         if (temp != NULL) {
 499                 bbody->part_id = (guint16)g_ascii_strtoull(temp, NULL, 10);
 500                 g_free(temp);
 501         }
 502
 503         bbody->encoding = bmsg_get_tag_data(&block_data, ENCODING_TAG);
 504         bbody->charset = bmsg_get_tag_data(&block_data, CHARSET_TAG);
 505         bbody->language = bmsg_get_tag_data(&block_data, LANGUAGE_TAG);
 506
 507         temp = bmsg_get_tag_data(&block_data, LENGTH_TAG);
 508
 509         if (temp != NULL) {
 510                 bbody->length = g_ascii_strtoull(temp, NULL, 10);
 511                 g_free(temp);
 512         }
 513
 514         bbody->msg = bmsg_get_parse_sub_block(&block_data, "MSG");
 515
 516         g_free(bbody_block_data_start);
 517         FN_END;
 518         return bbody;
 519 }
 520
 521 struct bmsg_vcard *bmsg_get_vcard_data(gchar *sub_block_data)
 522 {
 523         FN_START;
 524         struct bmsg_vcard *vcard;
 525         gchar *num;
 526         gchar *vcard_block_data_start = sub_block_data;
 527
 528         vcard = g_new0(struct bmsg_vcard, 1);
 529
 530         vcard->version = bmsg_get_tag_data(&sub_block_data, VER_TAG);
 531         vcard->n = bmsg_get_tag_data(&sub_block_data, VCARD_N_TAG);
 532         vcard->fn = bmsg_get_tag_data(&sub_block_data, VCARD_FN_TAG);
 533         num = bmsg_get_tag_data(&sub_block_data, VCARD_TEL_TAG);
 534         vcard->tel = __bt_get_valid_number(num);
 535         vcard->email = bmsg_get_tag_data(&sub_block_data, VCARD_EMAIL_TAG);
 536
 537         g_free(vcard_block_data_start);
 538         g_free(num);
 539         FN_END;
 540         return vcard;
 541 }
 542
 543 struct benv_data *bmsg_get_env_encapsulation_data(gchar **sub_block_data)
 544 {
 545         FN_START;
 546         gchar *is_valid;
 547         gchar *bbody_data = NULL;
 548
 549         is_valid = g_strstr_len(*sub_block_data, strlen(VCARD_BEGIN_TAG),
 550                                                         VCARD_BEGIN_TAG);
 551         if (is_valid == NULL)
 552                 return NULL;
 553
 554         if (g_enc_lvl > 3)
 555                 return NULL;
 556
 557         struct benv_data *rec_data = g_new0(struct benv_data, 1);
 558
 559         rec_data->encapsulation_level = g_enc_lvl;
 560         g_enc_lvl++;
 561
 562         while (is_valid != NULL) {
 563                 gchar *vcard_data = NULL;
 564                 struct bmsg_vcard *vcard;
 565
 566                 vcard_data = bmsg_get_parse_sub_block(sub_block_data, "VCARD");
 567                 if (vcard_data == NULL) {
 568                         ERR("parse error\n");
 569                         g_free(rec_data);
 570                         return NULL;
 571                 }
 572                 vcard = bmsg_get_vcard_data(vcard_data);
 573
 574                 rec_data->recipient_vcard = g_slist_append(
 575                                                 rec_data->recipient_vcard,
 576                                                 vcard);
 577
 578                 is_valid = g_strstr_len(*sub_block_data,
 579                                                 strlen(VCARD_BEGIN_TAG),
 580                                                 VCARD_BEGIN_TAG);
 581         }
 582
 583         is_valid = g_strstr_len(*sub_block_data, strlen(BBODY_TAG), BBODY_TAG);
 584
 585         if (!is_valid)
 586                 return rec_data;
 587
 588         bbody_data = bmsg_get_parse_sub_block(sub_block_data, "BBODY");
 589         if (bbody_data == NULL) {
 590                 ERR("parse error\n");
 591                 return rec_data;
 592         }
 593
 594         rec_data->body_content = bmsg_get_bbody_data(bbody_data);
 595         FN_END;
 596         return rec_data;
 597 }
 598
 599 struct bmsg_envelope *bmsg_get_envelope_data(gchar **block_data)
 600 {
 601         FN_START;
 602         gchar *sub_block_data;
 603         struct bmsg_envelope *envelope_data;
 604         struct benv_data *rec_data;
 605
 606         envelope_data = g_new0(struct bmsg_envelope, 1);
 607
 608         sub_block_data = bmsg_get_parse_sub_block(block_data, "BENV");
 609
 610         while (sub_block_data) {
 611
 612                 rec_data = bmsg_get_env_encapsulation_data(&sub_block_data);
 613
 614                 while (rec_data) {
 615                         envelope_data->env_data = g_slist_append(
 616                                                         envelope_data->env_data,
 617                                                         rec_data);
 618
 619                         rec_data = bmsg_get_env_encapsulation_data(
 620                                                         &sub_block_data);
 621                 }
 622                 g_free(sub_block_data);
 623                 sub_block_data = bmsg_get_parse_sub_block(&sub_block_data,
 624                                                                         "BENV");
 625         }
 626         g_free(sub_block_data);
 627         FN_END;
 628         return envelope_data;
 629 }
 630
 631 struct bmsg_data *bmsg_parse(gchar *buf)
 632 {
 633         FN_START;
 634         gchar *block_data;
 635         gchar *sub_block_data;
 636         gchar *block_data_start;
 637         struct bmsg_data *bmsg;
 638
 639         g_enc_lvl = 1;
 640
 641         block_data = bmsg_get_parse_sub_block(&buf, "BMSG");
 642         if (block_data == NULL)
 643                 return NULL;
 644
 645         block_data_start = block_data;
 646
 647         bmsg = g_new0(struct bmsg_data, 1);
 648
 649         bmsg->version = bmsg_get_tag_data(&block_data, VER_TAG);
 650         if (bmsg->version == NULL)
 651                 goto parse_fail;
 652
 653         bmsg->status = bmsg_get_tag_data(&block_data, STATUS_TAG);
 654         if (bmsg->status == NULL)
 655                 goto parse_fail;
 656
 657         bmsg->type = bmsg_get_tag_data(&block_data, TYPE_TAG);
 658         if (bmsg->type == NULL)
 659                 goto parse_fail;
 660
 661         bmsg->folder = bmsg_get_tag_data(&block_data, FOLDER_TAG);
 662         if (bmsg->folder == NULL)
 663                 goto parse_fail;
 664
 665         sub_block_data = bmsg_get_parse_sub_block(&block_data, "VCARD");
 666         if (sub_block_data != NULL) {
 667                 bmsg->originator_vcard_data = bmsg_get_vcard_data(sub_block_data);
 668                 if (bmsg->originator_vcard_data == NULL)
 669                         goto parse_fail;
 670         }
 671
 672         bmsg->envelope_data = bmsg_get_envelope_data(&block_data);
 673         if (bmsg->envelope_data == NULL)
 674                 goto parse_fail;
 675
 676         g_free(block_data_start);
 677
 678         DBG("Parse done");
 679         print_bmsg(bmsg);
 680         FN_END;
 681         return bmsg;
 682
 683 parse_fail:
 684         g_free(block_data_start);
 685
 686         ERR("Parse fail");
 687         bmsg_free_bmsg(bmsg);
 688         FN_END;
 689         return NULL;
 690 }
 691