src/s_sim.c

   1 /*
   2  * tel-plugin-imc
   3  *
   4  * Copyright (c) 2012 Samsung Electronics Co., Ltd. All rights reserved.
   5  *
   6  * Contact: Ankit Jogi <ankit.jogi@samsung.com>
   7  *
   8  * Licensed under the Apache License, Version 2.0 (the "License");
   9  * you may not use this file except in compliance with the License.
  10  * You may obtain a copy of the License at
  11  *
  12  * http://www.apache.org/licenses/LICENSE-2.0
  13  *
  14  * Unless required by applicable law or agreed to in writing, software
  15  * distributed under the License is distributed on an "AS IS" BASIS,
  16  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  17  * See the License for the specific language governing permissions and
  18  * limitations under the License.
  19  */
  20
  21 #include <stdio.h>
  22 #include <stdlib.h>
  23 #include <string.h>
  24 #include <glib.h>
  25 #include <tcore.h>
  26 #include <hal.h>
  27 #include <core_object.h>
  28 #include <plugin.h>
  29 #include <queue.h>
  30 #include <co_sim.h>
  31 #include <co_sms.h>
  32 #include <storage.h>
  33 #include <user_request.h>
  34 #include <server.h>
  35 #include <at.h>
  36
  37 #include "s_common.h"
  38 #include "s_sms.h"
  39 #include "s_sim.h"
  40
  41 #define ID_RESERVED_AT 0x0229
  42
  43 #define SWAPBYTES16(x) \
  44         { \
  45                 unsigned short int data = *(unsigned short int *)&(x);  \
  46                 data = ((data & 0xff00) >> 8) |   \
  47                            ((data & 0x00ff) << 8);        \
  48                 *(unsigned short int *)&(x) = data;      \
  49         }
  50
  51 enum s_sim_file_type_e {
  52         SIM_FTYPE_DEDICATED = 0x00, /**< Dedicated */
  53         SIM_FTYPE_TRANSPARENT = 0x01, /**< Transparent -binary type*/
  54         SIM_FTYPE_LINEAR_FIXED = 0x02, /**< Linear fixed - record type*/
  55         SIM_FTYPE_CYCLIC = 0x04, /**< Cyclic - record type*/
  56         SIM_FTYPE_INVALID_TYPE = 0xFF /**< Invalid type */
  57 };
  58
  59 enum s_sim_sec_op_e {
  60         SEC_PIN1_VERIFY,
  61         SEC_PIN2_VERIFY,
  62         SEC_PUK1_VERIFY,
  63         SEC_PUK2_VERIFY,
  64         SEC_SIM_VERIFY,
  65         SEC_ADM_VERIFY,
  66         SEC_PIN1_CHANGE,
  67         SEC_PIN2_CHANGE,
  68         SEC_PIN1_ENABLE,
  69         SEC_PIN1_DISABLE,
  70         SEC_PIN2_ENABLE,
  71         SEC_PIN2_DISABLE, // 10
  72         SEC_SIM_ENABLE,
  73         SEC_SIM_DISABLE,
  74         SEC_NET_ENABLE,
  75         SEC_NET_DISABLE,
  76         SEC_NS_ENABLE,
  77         SEC_NS_DISABLE,
  78         SEC_SP_ENABLE,
  79         SEC_SP_DISABLE,
  80         SEC_CP_ENABLE,
  81         SEC_CP_DISABLE, // 20
  82         SEC_FDN_ENABLE,
  83         SEC_FDN_DISABLE,
  84         SEC_PIN1_STATUS,
  85         SEC_PIN2_STATUS,
  86         SEC_FDN_STATUS,
  87         SEC_NET_STATUS,
  88         SEC_NS_STATUS,
  89         SEC_SP_STATUS,
  90         SEC_CP_STATUS,
  91         SEC_SIM_STATUS,
  92         SEC_SIM_UNKNOWN = 0xff
  93 };
  94
  95 struct s_sim_property {
  96         gboolean b_valid; /**< Valid or not */
  97         enum tel_sim_file_id file_id; /**< File identifier */
  98         enum s_sim_file_type_e file_type; /**< File type and structure */
  99         int rec_length; /**< Length of one record in file */
 100         int rec_count; /**< Number of records in file */
 101         int data_size; /**< File size */
 102         int current_index; /**< current index to read */
 103         enum s_sim_sec_op_e current_sec_op; /**< current index to read */
 104         struct tel_sim_mbi_list mbi_list;
 105         struct tel_sim_mb_number mb_list[SIM_MSP_CNT_MAX*5];
 106         struct tresp_sim_read files;
 107 };
 108
 109 static void _next_from_get_file_info(CoreObject *o, UserRequest *ur, enum tel_sim_file_id ef, enum tel_sim_access_result rt);
 110 static void _next_from_get_file_data(CoreObject *o, UserRequest *ur, enum tel_sim_access_result rt, int decode_ret);
 111 static gboolean _get_sim_type(CoreObject *o);
 112 static TReturn _get_file_info(CoreObject *o, UserRequest *ur, const enum tel_sim_file_id ef);
 113 static gboolean _get_file_data(CoreObject *o, UserRequest *ur, const enum tel_sim_file_id ef, const int offset, const int length);
 114 static gboolean _get_file_record(CoreObject *o, UserRequest *ur, const enum tel_sim_file_id ef, const int index, const int length);
 115 static void _sim_status_update(CoreObject *o, enum tel_sim_status sim_status);
 116 extern gboolean util_byte_to_hex(const char *byte_pdu, char *hex_pdu, int num_bytes);
 117
 118 static void sim_prepare_and_send_pending_request(CoreObject *co, const char *at_cmd, const char *prefix, enum tcore_at_command_type at_cmd_type, TcorePendingResponseCallback callback)
 119 {
 120         TcoreATRequest *req = NULL;
 121         TcoreHal *hal = NULL;
 122         TcorePending *pending = NULL;
 123         TReturn ret;
 124
 125
 126         hal = tcore_object_get_hal(co);
 127         dbg("hal: %p", hal);
 128
 129         pending = tcore_pending_new(co, 0);
 130         if (!pending)
 131                 dbg("Pending is NULL");
 132         req = tcore_at_request_new(at_cmd, prefix, at_cmd_type);
 133
 134         dbg("cmd : %s, prefix(if any) :%s, cmd_len : %d", req->cmd, req->prefix, strlen(req->cmd));
 135
 136         tcore_pending_set_request_data(pending, 0, req);
 137         tcore_pending_set_response_callback(pending, callback, NULL);
 138         tcore_pending_link_user_request(pending, NULL); // set user request to NULL - this is internal request
 139         ret = tcore_hal_send_request(hal, pending);
 140         return;
 141 }
 142
 143
 144 static enum tcore_response_command _find_resp_command(UserRequest *ur)
 145 {
 146         enum tcore_request_command command;
 147
 148         command = tcore_user_request_get_command(ur);
 149         switch (command) {
 150         case TREQ_SIM_VERIFY_PINS:
 151                 return TRESP_SIM_VERIFY_PINS;
 152                 break;
 153
 154         case TREQ_SIM_VERIFY_PUKS:
 155                 return TRESP_SIM_VERIFY_PUKS;
 156                 break;
 157
 158         case TREQ_SIM_CHANGE_PINS:
 159                 return TRESP_SIM_CHANGE_PINS;
 160                 break;
 161
 162         case TREQ_SIM_GET_FACILITY_STATUS:
 163                 return TRESP_SIM_GET_FACILITY_STATUS;
 164                 break;
 165
 166         case TREQ_SIM_DISABLE_FACILITY:
 167                 return TRESP_SIM_DISABLE_FACILITY;
 168                 break;
 169
 170         case TREQ_SIM_ENABLE_FACILITY:
 171                 return TRESP_SIM_ENABLE_FACILITY;
 172                 break;
 173
 174         case TREQ_SIM_GET_LOCK_INFO:
 175                 return TRESP_SIM_GET_LOCK_INFO;
 176                 break;
 177
 178         case TREQ_SIM_TRANSMIT_APDU:
 179                 return TRESP_SIM_TRANSMIT_APDU;
 180                 break;
 181
 182         case TREQ_SIM_GET_ATR:
 183                 return TRESP_SIM_GET_ATR;
 184                 break;
 185
 186         case TREQ_SIM_GET_ECC:
 187                 return TRESP_SIM_GET_ECC;
 188                 break;
 189
 190         case TREQ_SIM_GET_LANGUAGE:
 191                 return TRESP_SIM_GET_LANGUAGE;
 192                 break;
 193
 194         case TREQ_SIM_SET_LANGUAGE:
 195                 return TRESP_SIM_SET_LANGUAGE;
 196                 break;
 197
 198         case TREQ_SIM_GET_ICCID:
 199                 return TRESP_SIM_GET_ICCID;
 200                 break;
 201
 202         case TREQ_SIM_GET_MAILBOX:
 203                 return TRESP_SIM_GET_MAILBOX;
 204                 break;
 205
 206         case TREQ_SIM_GET_CALLFORWARDING:
 207                 return TRESP_SIM_GET_CALLFORWARDING;
 208                 break;
 209
 210         case TREQ_SIM_SET_CALLFORWARDING:
 211                 return TRESP_SIM_SET_CALLFORWARDING;
 212                 break;
 213
 214         case TREQ_SIM_GET_MESSAGEWAITING:
 215                 return TRESP_SIM_GET_MESSAGEWAITING;
 216                 break;
 217
 218         case TREQ_SIM_GET_CPHS_INFO:
 219                 return TRESP_SIM_GET_CPHS_INFO;
 220                 break;
 221
 222         case TREQ_SIM_GET_MSISDN:
 223                 return TRESP_SIM_GET_MSISDN;
 224                 break;
 225
 226         case TREQ_SIM_GET_SPN:
 227                 return TRESP_SIM_GET_SPN;
 228                 break;
 229
 230         case TREQ_SIM_GET_SPDI:
 231                 return TRESP_SIM_GET_SPDI;
 232                 break;
 233
 234         case TREQ_SIM_GET_OPL:
 235                 return TRESP_SIM_GET_OPL;
 236                 break;
 237
 238         case TREQ_SIM_GET_PNN:
 239                 return TRESP_SIM_GET_PNN;
 240                 break;
 241
 242         case TREQ_SIM_GET_CPHS_NETNAME:
 243                 return TRESP_SIM_GET_CPHS_NETNAME;
 244                 break;
 245
 246         case TREQ_SIM_GET_OPLMNWACT:
 247                 return TRESP_SIM_GET_OPLMNWACT;
 248                 break;
 249
 250         case TREQ_SIM_REQ_AUTHENTICATION:
 251                 return TRESP_SIM_REQ_AUTHENTICATION;
 252                 break;
 253
 254         default:
 255                 break;
 256         }
 257         return TRESP_UNKNOWN;
 258 }
 259
 260 static int _sim_get_current_pin_facility(enum s_sim_sec_op_e op)
 261 {
 262         int ret_type = 0;
 263
 264         dbg("current sec_op[%d]", op);
 265
 266         switch (op) {
 267         case SEC_PIN1_VERIFY:
 268         case SEC_PIN1_CHANGE:
 269                 ret_type = SIM_PTYPE_PIN1;
 270                 break;
 271
 272         case SEC_PIN2_VERIFY:
 273         case SEC_PIN2_CHANGE:
 274                 ret_type = SIM_PTYPE_PIN2;
 275                 break;
 276
 277         case SEC_PUK1_VERIFY:
 278                 ret_type = SIM_PTYPE_PUK1;
 279                 break;
 280
 281         case SEC_PUK2_VERIFY:
 282                 ret_type = SIM_PTYPE_PUK2;
 283                 break;
 284
 285         case SEC_SIM_VERIFY:
 286                 ret_type = SIM_PTYPE_SIM;
 287                 break;
 288
 289         case SEC_ADM_VERIFY:
 290                 ret_type = SIM_PTYPE_ADM;
 291                 break;
 292
 293         case SEC_PIN1_ENABLE:
 294         case SEC_PIN1_DISABLE:
 295         case SEC_PIN1_STATUS:
 296                 ret_type = SIM_FACILITY_SC;
 297                 break;
 298
 299         case SEC_SIM_ENABLE:
 300         case SEC_SIM_DISABLE:
 301         case SEC_SIM_STATUS:
 302                 ret_type = SIM_FACILITY_PS;
 303                 break;
 304
 305         case SEC_NET_ENABLE:
 306         case SEC_NET_DISABLE:
 307         case SEC_NET_STATUS:
 308                 ret_type = SIM_FACILITY_PN;
 309                 break;
 310
 311         case SEC_NS_ENABLE:
 312         case SEC_NS_DISABLE:
 313         case SEC_NS_STATUS:
 314                 ret_type = SIM_FACILITY_PU;
 315                 break;
 316
 317         case SEC_SP_ENABLE:
 318         case SEC_SP_DISABLE:
 319         case SEC_SP_STATUS:
 320                 ret_type = SIM_FACILITY_PP;
 321                 break;
 322
 323         case SEC_CP_ENABLE:
 324         case SEC_CP_DISABLE:
 325         case SEC_CP_STATUS:
 326                 ret_type = SIM_FACILITY_PC;
 327                 break;
 328
 329         case SEC_FDN_ENABLE:
 330         case SEC_FDN_DISABLE:
 331         case SEC_FDN_STATUS:
 332                 ret_type = SIM_FACILITY_FD;
 333                 break;
 334
 335         default:
 336                 dbg("not handled current sec op[%d]", op);
 337                 break;
 338         }
 339         return ret_type;
 340 }
 341
 342 static enum tel_sim_access_result _decode_status_word(unsigned short status_word1, unsigned short status_word2)
 343 {
 344         enum tel_sim_access_result rst = SIM_ACCESS_FAILED;
 345
 346         if (status_word1 == 0x93 && status_word2 == 0x00) {
 347                 rst = SIM_ACCESS_FAILED;
 348                 /*Failed SIM request command*/
 349                 dbg("error - SIM application toolkit busy [%x][%x]", status_word1, status_word2);
 350         } else if (status_word1 == 0x94 && status_word2 == 0x00) {
 351                 rst = SIM_ACCESS_FAILED;
 352                 /*Failed SIM request command*/
 353                 dbg("error - No EF Selected [%x][%x]", status_word1, status_word2);
 354         } else if (status_word1 == 0x94 && status_word2 == 0x02) {
 355                 rst = SIM_ACCESS_FAILED;
 356                 /*Failed SIM request command*/
 357                 dbg("error - Out of Range - Invalid address or record number[%x][%x]",
 358                         status_word1, status_word2);
 359         } else if (status_word1 == 0x94 && status_word2 == 0x04) {
 360                 rst = SIM_ACCESS_FILE_NOT_FOUND;
 361                 /*Failed SIM request command*/
 362                 dbg("error - File ID not found [%x][%x]", status_word1, status_word2);
 363         } else if (status_word1 == 0x94 && status_word2 == 0x08) {
 364                 rst = SIM_ACCESS_FAILED; /* MOdem not support */
 365                 /*Failed SIM request command*/
 366                 dbg("error - File is inconsistent with command - Modem not support or USE IPC [%x][%x]",
 367                         status_word1, status_word2);
 368         } else if (status_word1 == 0x98 && status_word2 == 0x02) {
 369                 rst = SIM_ACCESS_CONDITION_NOT_SATISFIED;
 370                 /*Failed SIM request command*/
 371                 dbg("error - CHV not initialized [%x][%x]", status_word1, status_word2);
 372         } else if (status_word1 == 0x98 && status_word2 == 0x04) {
 373                 rst = SIM_ACCESS_CONDITION_NOT_SATISFIED;
 374                 /*Failed SIM request command*/
 375                 dbg("error - Access condition not fullfilled [%x][%x]", status_word1, status_word2);
 376                 dbg("error -Unsuccessful CHV verification - at least one attempt left [%x][%x]",
 377                         status_word1, status_word2);
 378                 dbg("error - Unsuccessful Unblock CHV - at least one attempt left [%x][%x]",
 379                         status_word1, status_word2);
 380                 dbg("error - Authentication failure [%x][%x]", status_word1, status_word2);
 381         } else if (status_word1 == 0x98 && status_word2 == 0x08) {
 382                 rst = SIM_ACCESS_CONDITION_NOT_SATISFIED;
 383                 /*Failed SIM request command*/
 384                 dbg("error - Contradiction with CHV status [%x][%x]", status_word1, status_word2);
 385         } else if (status_word1 == 0x98 && status_word2 == 0x10) {
 386                 rst = SIM_ACCESS_CONDITION_NOT_SATISFIED;
 387                 /*Failed SIM request command*/
 388                 dbg("error - Contradiction with invalidation status [%x][%x]",
 389                         status_word1, status_word2);
 390         } else if (status_word1 == 0x98 && status_word2 == 0x40) {
 391                 rst = SIM_ACCESS_CONDITION_NOT_SATISFIED;
 392                 /*Failed SIM request command*/
 393                 dbg("error -Unsuccessful CHV verification - no attempt left [%x][%x]",
 394                         status_word1, status_word2);
 395                 dbg("error - Unsuccessful Unblock CHV - no attempt left [%x][%x]",
 396                         status_word1, status_word2);
 397                 dbg("error - CHV blocked [%x][%x]", status_word1, status_word2);
 398         } else if (status_word1 == 0x67 && status_word2 == 0x00) {
 399                 rst = SIM_ACCESS_FAILED;
 400                 dbg("error -Incorrect Parameter 3 [%x][%x]", status_word1, status_word2);
 401         } else if (status_word1 == 0x6B && status_word2 == 0x00) {
 402                 rst = SIM_ACCESS_FAILED;
 403                 dbg("error -Incorrect Parameter 1 or 2 [%x][%x]", status_word1, status_word2);
 404         } else if (status_word1 == 0x6D && status_word2 == 0x00) {
 405                 rst = SIM_ACCESS_CONDITION_NOT_SATISFIED;
 406                 dbg("error -Unknown instruction given as command [%x][%x]", status_word1, status_word2);
 407         } else if (status_word1 == 0x6E && status_word2 == 0x00) {
 408                 rst = SIM_ACCESS_CONDITION_NOT_SATISFIED;
 409                 dbg("error -Unknown instruction given as command [%x][%x]", status_word1, status_word2);
 410         } else if (status_word1 == 0x69 && status_word2 == 0x82) {
 411                 rst = SIM_ACCESS_CONDITION_NOT_SATISFIED;
 412                 dbg("error -Access denied [%x][%x]", status_word1, status_word2);
 413         } else if (status_word1 == 0x6A && status_word2 == 0x87) {
 414                 rst = SIM_ACCESS_FAILED;
 415                 dbg("error -Incorrect parameters [%x][%x]", status_word1, status_word2);
 416         } else if (status_word1 == 0x6A && status_word2 == 0x82) {
 417                 rst = SIM_ACCESS_FILE_NOT_FOUND; // not sure of the SW1 and SW2 meaning here
 418                 dbg("error -File Not found [%x][%x]", status_word1, status_word2);
 419         } else if (status_word1 == 0x6A && status_word2 == 0x83) {
 420                 rst = SIM_ACCESS_FILE_NOT_FOUND; // not sure of the SW1 and SW2 meaning here
 421                 dbg("error -Record Not found [%x][%x]", status_word1, status_word2);
 422         } else {
 423                 rst = SIM_ACCESS_CARD_ERROR;
 424                 dbg("error -Unknown state [%x][%x]", status_word1, status_word2);
 425         }
 426         return rst;
 427 }
 428
 429 static gboolean _sim_check_identity(CoreObject *o, struct tel_sim_imsi *imsi)
 430 {
 431         Server *s = NULL;
 432         Storage *strg = NULL;
 433         char *old_imsi = NULL;
 434         char new_imsi[15 + 1] = {0, };
 435
 436         s = tcore_plugin_ref_server(tcore_object_ref_plugin(o));
 437         if (!s) {
 438                 dbg("there is no valid server at this point");
 439                 return FALSE;
 440         }
 441         strg = (Storage *)tcore_server_find_storage(s, "vconf");
 442         if (!strg) {
 443                 dbg("there is no valid storage plugin");
 444                 return FALSE;
 445         }
 446         memcpy(&new_imsi, imsi->plmn, strlen(imsi->plmn));
 447         memcpy(&new_imsi[strlen(imsi->plmn)], imsi->msin, strlen(imsi->msin));
 448         new_imsi[strlen(imsi->plmn) + strlen(imsi->msin)] = '\0';
 449
 450         old_imsi = tcore_storage_get_string(strg, STORAGE_KEY_TELEPHONY_IMSI);
 451         dbg("old_imsi[%s],newImsi[%s]", old_imsi, new_imsi);
 452
 453         if (old_imsi != NULL) {
 454                 if (strncmp(old_imsi, new_imsi, 15) != 0) {
 455                         dbg("NEW SIM");
 456                         if (tcore_storage_set_string(strg, STORAGE_KEY_TELEPHONY_IMSI, (const char *)&new_imsi) == FALSE) {
 457                                 dbg("[FAIL] UPDATE STORAGE_KEY_TELEPHONY_IMSI");
 458                         }
 459                         tcore_sim_set_identification(o, TRUE);
 460                 } else {
 461                         dbg("SAME SIM");
 462                         tcore_sim_set_identification(o, FALSE);
 463                 }
 464         } else {
 465                 dbg("OLD SIM VALUE IS NULL. NEW SIM");
 466                 if (tcore_storage_set_string(strg, STORAGE_KEY_TELEPHONY_IMSI, (const char *)&new_imsi) == FALSE) {
 467                         dbg("[FAIL] UPDATE STORAGE_KEY_TELEPHONY_IMSI");
 468                 }
 469                 tcore_sim_set_identification(o, TRUE);
 470         }
 471         return 1;
 472 }
 473
 474 static void _next_from_get_file_info(CoreObject *o, UserRequest *ur, enum tel_sim_file_id ef, enum tel_sim_access_result rt)
 475 {
 476         struct tresp_sim_read resp = {0, };
 477         struct s_sim_property *file_meta = NULL;
 478
 479         dbg("EF[0x%x] access Result[%d]", ef, rt);
 480
 481         resp.result = rt;
 482         memset(&resp.data, 0x00, sizeof(resp.data));
 483         file_meta = (struct s_sim_property *)tcore_user_request_ref_metainfo(ur, NULL);
 484
 485         if ((ef != SIM_EF_ELP && ef != SIM_EF_LP && ef != SIM_EF_USIM_PL && ef != SIM_EF_CPHS_CPHS_INFO)
 486                 && (rt != SIM_ACCESS_SUCCESS)) {
 487                 tcore_user_request_send_response(ur, _find_resp_command(ur), sizeof(struct tresp_sim_read), &resp);
 488                 return;
 489         }
 490
 491         switch (ef) {
 492         case SIM_EF_ELP:
 493                 if (rt == SIM_ACCESS_SUCCESS) {
 494                         dbg("[SIM DATA] exist EFELP/PL(0x2F05)");
 495                         /*                              if (po->language_file == 0x00)
 496                          po->language_file = SIM_EF_ELP;*/
 497                         _get_file_data(o, ur, ef, 0, file_meta->data_size);
 498                 } else {
 499                         if (tcore_sim_get_type(o) == SIM_TYPE_GSM) {
 500                                 dbg("[SIM DATA]SIM_EF_ELP(2F05) access fail. Request SIM_EF_LP(0x6F05) info");
 501                                 /* The ME requests the Language Preference (EFLP) if EFELP is not available */
 502                                 _get_file_info(o, ur, SIM_EF_LP);
 503                         } else if (tcore_sim_get_type(o) == SIM_TYPE_USIM) {
 504                                 dbg(
 505                                         " [SIM DATA]fail to get Language information in USIM(EF-LI(6F05),EF-PL(2F05)). Request SIM_EF_ECC(0x6FB7) info");
 506                                 /* EFELPand EFLI not present at this point. */
 507                                 /*                                      po->language.lang_cnt = 0;*/
 508                                 tcore_user_request_send_response(ur, _find_resp_command(ur),
 509                                                                                                  sizeof(struct tresp_sim_read), &resp);
 510                                 return;
 511                         }
 512                 }
 513                 break;
 514
 515         case SIM_EF_LP:   // same with SIM_EF_USIM_LI
 516                 if (rt == SIM_ACCESS_SUCCESS) {
 517                         dbg("[SIM DATA] exist EFLP/LI(0x6F05)");
 518                         _get_file_data(o, ur, ef, 0, file_meta->data_size);
 519                 } else {
 520                         dbg("[SIM DATA]SIM_EF_LP/LI(6F05) access fail. Current CardType[%d]",
 521                                 tcore_sim_get_type(o));
 522                         if (tcore_sim_get_type(o) == SIM_TYPE_GSM) {
 523                                 tcore_user_request_send_response(ur, _find_resp_command(ur),
 524                                                                                                  sizeof(struct tresp_sim_read), &resp);
 525                                 return;
 526                         }
 527                         /* if EFLI is not present, then the language selection shall be as defined in EFPL at the MF level      */
 528                         else if (tcore_sim_get_type(o) == SIM_TYPE_USIM) {
 529                                 dbg("[SIM DATA] try USIM EFPL(0x2F05)");
 530                                 _get_file_info(o, ur, SIM_EF_ELP);
 531                         }
 532                 }
 533                 break;
 534
 535         case SIM_EF_USIM_PL:
 536                 if (rt == SIM_ACCESS_SUCCESS) {
 537                         dbg("[SIM DATA] exist EFELP/PL(0x2F05)");
 538                         _get_file_data(o, ur, SIM_EF_ELP, 0, file_meta->data_size);
 539                 } else {
 540                         /* EFELIand EFPL not present, so set language count as zero and select ECC */
 541                         dbg(
 542                                 " [SIM DATA]SIM_EF_USIM_PL(2A05) access fail. Request SIM_EF_ECC(0x6FB7) info");
 543                         tcore_user_request_send_response(ur, _find_resp_command(ur),
 544                                                                                          sizeof(struct tresp_sim_read), &resp);
 545                         return;
 546                 }
 547                 break;
 548
 549         case SIM_EF_ECC:
 550                 if (tcore_sim_get_type(o) == SIM_TYPE_GSM) {
 551                         _get_file_data(o, ur, ef, 0, file_meta->data_size);
 552                 } else if (tcore_sim_get_type(o) == SIM_TYPE_USIM) {
 553                         if (file_meta->rec_count > SIM_ECC_RECORD_CNT_MAX) {
 554                                 file_meta->rec_count = SIM_ECC_RECORD_CNT_MAX;
 555                         }
 556
 557                         file_meta->current_index++;
 558                         _get_file_record(o, ur, ef, file_meta->current_index, file_meta->rec_length);
 559                 }
 560                 break;
 561
 562         case SIM_EF_ICCID:
 563         case SIM_EF_IMSI:
 564         case SIM_EF_SST:
 565         case SIM_EF_SPN:
 566         case SIM_EF_SPDI:
 567         case SIM_EF_CPHS_CALL_FORWARD_FLAGS:
 568         case SIM_EF_CPHS_VOICE_MSG_WAITING:
 569         case SIM_EF_CPHS_OPERATOR_NAME_STRING:
 570         case SIM_EF_CPHS_OPERATOR_NAME_SHORT_FORM_STRING:
 571         case SIM_EF_CPHS_DYNAMICFLAGS:
 572         case SIM_EF_CPHS_DYNAMIC2FLAG:
 573         case SIM_EF_CPHS_CUSTOMER_SERVICE_PROFILE:
 574         case SIM_EF_CPHS_CUSTOMER_SERVICE_PROFILE_LINE2:
 575                 _get_file_data(o, ur, ef, 0, file_meta->data_size);
 576                 break;
 577
 578         case SIM_EF_CPHS_CPHS_INFO:
 579                 if (rt == SIM_ACCESS_SUCCESS) {
 580                         tcore_sim_set_cphs_status(o, TRUE);
 581                         if (!tcore_user_request_ref_communicator(ur)) {
 582                                 dbg("internal CPHS INFO request before sim status update");
 583                                 _sim_status_update(o, SIM_STATUS_INIT_COMPLETED);
 584                         } else {
 585                                 dbg("external CPHS INFO request");
 586                                 _get_file_data(o, ur, ef, 0, file_meta->data_size);
 587                         }
 588                 } else {
 589                         tcore_sim_set_cphs_status(o, FALSE);
 590                         if (!tcore_user_request_ref_communicator(ur)) {
 591                                 dbg("internal CPHS INFO request before sim status update");
 592                                 _sim_status_update(o, SIM_STATUS_INIT_COMPLETED);
 593                         } else {
 594                                 dbg("external CPHS INFO request");
 595                                 tcore_user_request_send_response(ur, _find_resp_command(ur),
 596                                                                                                  sizeof(struct tresp_sim_read), &resp);
 597                         }
 598                 }
 599                 break;
 600
 601
 602         case SIM_EF_USIM_CFIS:
 603                 if (file_meta->rec_count > SIM_CF_RECORD_CNT_MAX) {
 604                         file_meta->rec_count = SIM_CF_RECORD_CNT_MAX;
 605                 }
 606                 file_meta->current_index++;
 607                 _get_file_record(o, ur, ef, file_meta->current_index, file_meta->rec_length);
 608                 break;
 609
 610         case SIM_EF_OPL:
 611         case SIM_EF_PNN:
 612         case SIM_EF_USIM_MWIS:
 613         case SIM_EF_USIM_MBI:
 614         case SIM_EF_MBDN:
 615         case SIM_EF_CPHS_MAILBOX_NUMBERS:
 616         case SIM_EF_CPHS_INFORMATION_NUMBERS:
 617         case SIM_EF_MSISDN:
 618                 file_meta->current_index++;
 619                 _get_file_record(o, ur, ef, file_meta->current_index, file_meta->rec_length);
 620                 break;
 621
 622         default:
 623                 dbg("error - File id for get file info [0x%x]", ef);
 624                 break;
 625         }
 626         return;
 627 }
 628
 629 static void _next_from_get_file_data(CoreObject *o, UserRequest *ur, enum tel_sim_access_result rt, int decode_ret)
 630 {
 631         struct s_sim_property *file_meta = NULL;
 632
 633         dbg("Entry");
 634
 635         file_meta = (struct s_sim_property *)tcore_user_request_ref_metainfo(ur, NULL);
 636         dbg("[SIM]EF[0x%x] read rt[%d] Decode rt[%d]", file_meta->file_id, rt, decode_ret);
 637         switch (file_meta->file_id) {
 638         case SIM_EF_ELP:
 639         case SIM_EF_USIM_PL:
 640         case SIM_EF_LP:
 641         case SIM_EF_USIM_LI:
 642                 if (decode_ret == TRUE) {
 643                         if (file_meta->file_id == SIM_EF_LP || file_meta->file_id == SIM_EF_USIM_LI) {
 644 /*                                      po->language_file = SIM_EF_LP;*/
 645                         } else if (file_meta->file_id == SIM_EF_ELP || file_meta->file_id == SIM_EF_USIM_PL) {
 646 /*                                      po->language_file = SIM_EF_ELP;*/
 647                         }
 648                         tcore_user_request_send_response(ur, _find_resp_command(ur), sizeof(struct tresp_sim_read), &file_meta->files);
 649                 } else {
 650                         /* 2G */
 651                         /* The ME requests the Extended Language Preference. The ME only requests the Language Preference (EFLP) if at least one of the following conditions holds:
 652                          -      EFELP is not available;
 653                          -      EFELP does not contain an entry corresponding to a language specified in ISO 639[30];
 654                          -      the ME does not support any of the languages in EFELP.
 655                          */
 656                         /* 3G */
 657                         /* The ME only requests the Language Preference (EFPL) if at least one of the following conditions holds:
 658                          -      if the EFLI has the value 'FFFF' in its highest priority position
 659                          -      if the ME does not support any of the language codes indicated in EFLI , or if EFLI is not present
 660                          */
 661                         if (tcore_sim_get_type(o) == SIM_TYPE_GSM) {
 662                                 if (file_meta->file_id == SIM_EF_LP) {
 663                                         tcore_user_request_send_response(ur, _find_resp_command(ur), sizeof(struct tresp_sim_read), &file_meta->files);
 664                                 } else {
 665                                         _get_file_info(o, ur, SIM_EF_LP);
 666                                 }
 667                         } else if (tcore_sim_get_type(o) == SIM_TYPE_USIM) {
 668                                 if (file_meta->file_id == SIM_EF_LP || file_meta->file_id == SIM_EF_USIM_LI) {
 669                                         _get_file_info(o, ur, SIM_EF_ELP);
 670                                 } else {
 671                                         tcore_user_request_send_response(ur, _find_resp_command(ur), sizeof(struct tresp_sim_read), &file_meta->files);
 672                                 }
 673                         }
 674                 }
 675                 break;
 676
 677         case SIM_EF_ECC:
 678                 if (tcore_sim_get_type(o) == SIM_TYPE_USIM) {
 679                         if (file_meta->current_index == file_meta->rec_count) {
 680                                 tcore_user_request_send_response(ur, _find_resp_command(ur), sizeof(struct tresp_sim_read), &file_meta->files);
 681                         } else {
 682                                 file_meta->current_index++;
 683                                 _get_file_record(o, ur, file_meta->file_id, file_meta->current_index, file_meta->rec_length);
 684                         }
 685                 } else if (tcore_sim_get_type(o) == SIM_TYPE_GSM) {
 686                         tcore_user_request_send_response(ur, _find_resp_command(ur), sizeof(struct tresp_sim_read), &file_meta->files);
 687                 } else {
 688                         dbg("[SIM DATA]Invalid CardType[%d] Unable to handle", tcore_sim_get_type(o));
 689                 }
 690                 break;
 691
 692         case SIM_EF_IMSI:
 693                 ur = tcore_user_request_new(NULL, NULL);   // this is for using ur metainfo set/ref functionality.
 694                 _get_file_info(o, ur, SIM_EF_CPHS_CPHS_INFO);
 695                 break;
 696
 697         case SIM_EF_MSISDN:
 698                 if (file_meta->current_index == file_meta->rec_count) {
 699                         tcore_user_request_send_response(ur, _find_resp_command(ur), sizeof(struct tresp_sim_read), &file_meta->files);
 700                 } else {
 701                         file_meta->current_index++;
 702                         _get_file_record(o, ur, file_meta->file_id, file_meta->current_index, file_meta->rec_length);
 703                 }
 704                 break;
 705
 706         case SIM_EF_OPL:
 707                 if (file_meta->current_index == file_meta->rec_count) {
 708                         tcore_user_request_send_response(ur, _find_resp_command(ur), sizeof(struct tresp_sim_read), &file_meta->files);
 709                 } else {
 710                         file_meta->current_index++;
 711                         _get_file_record(o, ur, file_meta->file_id, file_meta->current_index, file_meta->rec_length);
 712                 }
 713                 break;
 714
 715         case SIM_EF_PNN:
 716                 if (file_meta->current_index == file_meta->rec_count) {
 717                         tcore_user_request_send_response(ur, _find_resp_command(ur), sizeof(struct tresp_sim_read), &file_meta->files);
 718                 } else {
 719                         file_meta->current_index++;
 720                         _get_file_record(o, ur, file_meta->file_id, file_meta->current_index, file_meta->rec_length);
 721                 }
 722                 break;
 723
 724         case SIM_EF_USIM_CFIS:
 725         case SIM_EF_USIM_MWIS:
 726         case SIM_EF_USIM_MBI:
 727         case SIM_EF_MBDN:
 728         case SIM_EF_CPHS_MAILBOX_NUMBERS:
 729         case SIM_EF_CPHS_INFORMATION_NUMBERS:
 730                 if (file_meta->current_index == file_meta->rec_count) {
 731                         tcore_user_request_send_response(ur, _find_resp_command(ur), sizeof(struct tresp_sim_read), &file_meta->files);
 732                 } else {
 733                         file_meta->current_index++;
 734                         _get_file_record(o, ur, file_meta->file_id, file_meta->current_index, file_meta->rec_length);
 735                 }
 736                 break;
 737
 738         case SIM_EF_CPHS_OPERATOR_NAME_STRING:
 739                 file_meta->files.result = rt;
 740                 if (decode_ret == TRUE && rt == SIM_ACCESS_SUCCESS) {
 741                         memcpy(file_meta->files.data.cphs_net.full_name, file_meta->files.data.cphs_net.full_name, strlen((char *)file_meta->files.data.cphs_net.full_name));
 742                 }
 743                 _get_file_info(o, ur, SIM_EF_CPHS_OPERATOR_NAME_SHORT_FORM_STRING);
 744                 break;
 745
 746         case SIM_EF_CPHS_OPERATOR_NAME_SHORT_FORM_STRING:
 747                 if (file_meta->files.result == SIM_ACCESS_SUCCESS || file_meta->files.result == SIM_ACCESS_SUCCESS) {
 748                         file_meta->files.result = SIM_ACCESS_SUCCESS;
 749                 }
 750                 if (strlen((char *)file_meta->files.data.cphs_net.full_name)) {
 751                         memcpy(&file_meta->files.data.cphs_net.full_name, &file_meta->files.data.cphs_net.full_name, strlen((char *)file_meta->files.data.cphs_net.full_name));
 752                 }
 753                 tcore_user_request_send_response(ur, _find_resp_command(ur), sizeof(struct tresp_sim_read), &file_meta->files);
 754                 break;
 755
 756         case SIM_EF_ICCID:
 757         case SIM_EF_SST:
 758         case SIM_EF_SPN:
 759         case SIM_EF_SPDI:
 760         case SIM_EF_OPLMN_ACT:
 761         case SIM_EF_CPHS_CPHS_INFO:
 762         case SIM_EF_CPHS_CALL_FORWARD_FLAGS:
 763         case SIM_EF_CPHS_VOICE_MSG_WAITING:
 764         case SIM_EF_CPHS_DYNAMICFLAGS:
 765         case SIM_EF_CPHS_DYNAMIC2FLAG:
 766         case SIM_EF_CPHS_CUSTOMER_SERVICE_PROFILE:
 767         case SIM_EF_CPHS_CUSTOMER_SERVICE_PROFILE_LINE2:
 768                 tcore_user_request_send_response(ur, _find_resp_command(ur), sizeof(struct tresp_sim_read), &file_meta->files);
 769                 break;
 770
 771         default:
 772                 dbg("File id not handled [0x%x]", file_meta->file_id);
 773                 break;
 774         }
 775 }
 776
 777 static void _sim_status_update(CoreObject *o, enum tel_sim_status sim_status)
 778 {
 779         struct tnoti_sim_status noti_data = {0, };
 780
 781         if (sim_status != tcore_sim_get_status(o)) {
 782                 dbg("Change in SIM State - Old State: [0x%02x] New State: [0x%02x]",
 783                                 tcore_sim_get_status(o), sim_status);
 784
 785                 /* Update SIM Status */
 786                 tcore_sim_set_status(o, sim_status);
 787                 noti_data.sim_status = sim_status;
 788
 789                 /* Send notification */
 790                 tcore_server_send_notification(tcore_plugin_ref_server(tcore_object_ref_plugin(o)),
 791                                 o, TNOTI_SIM_STATUS, sizeof(noti_data), &noti_data);
 792         }
 793 }
 794
 795 static void _response_get_sim_type(TcorePending *p, int data_len, const void *data, void *user_data)
 796 {
 797         const TcoreATResponse *resp = data;
 798         UserRequest *ur = NULL;
 799         CoreObject *co_sim = NULL;
 800         struct s_sim_property *sp = NULL;
 801         GSList *tokens = NULL;
 802         enum tel_sim_type sim_type = SIM_TYPE_UNKNOWN;
 803         const char *line;
 804         int state;
 805
 806         dbg("Entry");
 807
 808         co_sim = tcore_pending_ref_core_object(p);
 809         sp = tcore_sim_ref_userdata(co_sim);
 810         ur = tcore_pending_ref_user_request(p);
 811
 812         if (resp->success > 0) {
 813                 dbg("RESPONSE OK");
 814                 if (resp->lines) {
 815                         line = (const char *)resp->lines->data;
 816                         tokens = tcore_at_tok_new(line);
 817                         if (g_slist_length(tokens) != 1) {
 818                                 msg("Invalid message");
 819                                 tcore_at_tok_free(tokens);
 820                                 return;
 821                         }
 822                 }
 823                 state = atoi(g_slist_nth_data(tokens, 0));
 824                 dbg("SIM Type is %d", state);
 825
 826                 if (state == 0) {
 827                         sim_type = SIM_TYPE_GSM;
 828                 } else if (state == 1) {
 829                         sim_type = SIM_TYPE_USIM;
 830                 } else {
 831                         sim_type = SIM_TYPE_UNKNOWN;
 832                 }
 833         } else {
 834                 dbg("RESPONSE NOK");
 835                 sim_type = SIM_TYPE_UNKNOWN;
 836         }
 837
 838         tcore_sim_set_type(co_sim, sim_type);
 839
 840         if (sim_type != SIM_TYPE_UNKNOWN) {
 841                 /* set user request for using ur metainfo set/ref functionality */
 842                 ur = tcore_user_request_new(NULL, NULL);
 843                 _get_file_info(co_sim, ur, SIM_EF_IMSI);
 844         }
 845
 846         tcore_at_tok_free(tokens);
 847         dbg("Exit");
 848 }
 849
 850 static void _response_get_file_info(TcorePending *p, int data_len, const void *data, void *user_data)
 851 {
 852         const TcoreATResponse *resp = data;
 853         UserRequest *ur = NULL;
 854         CoreObject *co_sim = NULL;
 855         struct s_sim_property *file_meta = NULL;
 856         GSList *tokens = NULL;
 857         enum tel_sim_access_result rt;
 858         const char *line = NULL;
 859         int sw1 = 0;
 860         int sw2 = 0;
 861
 862         dbg("Entry");
 863
 864         co_sim = tcore_pending_ref_core_object(p);
 865         ur = tcore_pending_ref_user_request(p);
 866         file_meta = (struct s_sim_property *)tcore_user_request_ref_metainfo(ur, NULL);
 867
 868         if (resp->success > 0) {
 869                 dbg("RESPONSE OK");
 870                 if (resp->lines) {
 871                         line = (const char *)resp->lines->data;
 872                         tokens = tcore_at_tok_new(line);
 873                         if (g_slist_length(tokens) < 2) {
 874                                 err("Invalid message");
 875                                 tcore_at_tok_free(tokens);
 876                                 return;
 877                         }
 878                 }
 879                 sw1 = atoi(g_slist_nth_data(tokens, 0));
 880                 sw2 = atoi(g_slist_nth_data(tokens, 1));
 881
 882                 /*1. SIM access success case*/
 883                 if ((sw1 == 0x90 && sw2 == 0x00) || sw1 == 0x91) {
 884                         unsigned char tag_len = 0; /*   1 or 2 bytes ??? */
 885                         unsigned short record_len = 0;
 886                         char num_of_records = 0;
 887                         unsigned char file_id_len = 0;
 888                         unsigned short file_id = 0;
 889                         unsigned short file_size = 0;
 890                         unsigned short file_type = 0;
 891                         unsigned short arr_file_id = 0;
 892                         int arr_file_id_rec_num = 0;
 893
 894                         /*      handling only last 3 bits */
 895                         unsigned char file_type_tag = 0x07;
 896                         unsigned char *ptr_data;
 897
 898                         char *hexData;
 899                         char *tmp;
 900                         char *recordData = NULL;
 901                         hexData = g_slist_nth_data(tokens, 2);
 902                         dbg("hexData: %s", hexData);
 903                         dbg("hexData: %s", hexData + 1);
 904
 905                         tmp = util_removeQuotes(hexData);
 906                         recordData = util_hexStringToBytes(tmp);
 907                         util_hex_dump("   ", strlen(hexData) / 2, recordData);
 908                         g_free(tmp);
 909
 910                         ptr_data = (unsigned char *)recordData;
 911                         if (tcore_sim_get_type(co_sim) == SIM_TYPE_USIM) {
 912                                 /*
 913                                  ETSI TS 102 221 v7.9.0
 914                                  - Response Data
 915                                  '62'   FCP template tag
 916                                  - Response for an EF
 917                                  '82'   M       File Descriptor
 918                                  '83'   M       File Identifier
 919                                  'A5'   O       Proprietary information
 920                                  '8A'   M       Life Cycle Status Integer
 921                                  '8B', '8C' or 'AB'     C1      Security attributes
 922                                  '80'   M       File size
 923                                  '81'   O       Total file size
 924                                  '88'   O       Short File Identifier (SFI)
 925                                  */
 926
 927                                 /* rsim.res_len has complete data length received */
 928
 929                                 /* FCP template tag - File Control Parameters tag*/
 930                                 if (*ptr_data == 0x62) {
 931                                         /* parse complete FCP tag*/
 932                                         /* increment to next byte */
 933                                         ptr_data++;
 934                                         tag_len = *ptr_data++;
 935                                         dbg("tag_len: %02x", tag_len);
 936                                         /* FCP file descriptor - file type, accessibility, DF, ADF etc*/
 937                                         if (*ptr_data == 0x82) {
 938                                                 /* increment to next byte */
 939                                                 ptr_data++;
 940                                                 /* 2 or 5 value*/
 941                                                 ptr_data++;
 942                                                 /*      unsigned char file_desc_len = *ptr_data++;*/
 943                                                 /*      dbg("file descriptor length: [%d]", file_desc_len);*/
 944                                                 /* TBD: currently capture only file type : ignore sharable, non sharable, working, internal etc*/
 945                                                 /* consider only last 3 bits*/
 946                                                 dbg("file_type_tag: %02x", file_type_tag);
 947                                                 file_type_tag = file_type_tag & (*ptr_data);
 948                                                 dbg("file_type_tag: %02x", file_type_tag);
 949
 950                                                 switch (file_type_tag) {
 951                                                 /* increment to next byte */
 952                                                 // ptr_data++;
 953                                                 case 0x1:
 954                                                         dbg("Getting FileType: [Transparent file type]");
 955                                                         file_type = SIM_FTYPE_TRANSPARENT;
 956
 957                                                         /* increment to next byte */
 958                                                         ptr_data++;
 959                                                         /* increment to next byte */
 960                                                         ptr_data++;
 961                                                         break;
 962
 963                                                 case 0x2:
 964                                                         dbg("Getting FileType: [Linear fixed file type]");
 965                                                         /* increment to next byte */
 966                                                         ptr_data++;
 967                                                         /*      data coding byte - value 21 */
 968                                                         ptr_data++;
 969                                                         /*      2bytes */
 970                                                         memcpy(&record_len, ptr_data, 2);
 971                                                         /* swap bytes */
 972                                                         SWAPBYTES16(record_len);
 973                                                         ptr_data = ptr_data + 2;
 974                                                         num_of_records = *ptr_data++;
 975                                                         /* Data lossy conversation from enum (int) to unsigned char */
 976                                                         file_type = SIM_FTYPE_LINEAR_FIXED;
 977                                                         break;
 978
 979                                                 case 0x6:
 980                                                         dbg("Cyclic fixed file type");
 981                                                         /* increment to next byte */
 982                                                         ptr_data++;
 983                                                         /*      data coding byte - value 21 */
 984                                                         ptr_data++;
 985                                                         /*      2bytes */
 986                                                         memcpy(&record_len, ptr_data, 2);
 987                                                         /* swap bytes */
 988                                                         SWAPBYTES16(record_len);
 989                                                         ptr_data = ptr_data + 2;
 990                                                         num_of_records = *ptr_data++;
 991                                                         file_type = SIM_FTYPE_CYCLIC;
 992                                                         break;
 993
 994                                                 default:
 995                                                         dbg("not handled file type [0x%x]", *ptr_data);
 996                                                         break;
 997                                                 }
 998                                         } else {
 999                                                 dbg("INVALID FCP received - DEbug!");
1000                                                 tcore_at_tok_free(tokens);
1001                                                 g_free(recordData);
1002                                                 return;
1003                                         }
1004
1005                                         /*File identifier - file id?? */ // 0x84,0x85,0x86 etc are currently ignored and not handled
1006                                         if (*ptr_data == 0x83) {
1007                                                 /* increment to next byte */
1008                                                 ptr_data++;
1009                                                 file_id_len = *ptr_data++;
1010                                                 dbg("file_id_len: %02x", file_id_len);
1011
1012                                                 memcpy(&file_id, ptr_data, file_id_len);
1013                                                 dbg("file_id: %x", file_id);
1014
1015                                                 /* swap bytes    */
1016                                                 SWAPBYTES16(file_id);
1017                                                 dbg("file_id: %x", file_id);
1018
1019                                                 ptr_data = ptr_data + 2;
1020                                                 dbg("Getting FileID=[0x%x]", file_id);
1021                                         } else {
1022                                                 dbg("INVALID FCP received - DEbug!");
1023                                                 tcore_at_tok_free(tokens);
1024                                                 g_free(recordData);
1025                                                 return;
1026                                         }
1027
1028                                         /*      proprietary information */
1029                                         if (*ptr_data == 0xA5) {
1030                                                 unsigned short prop_len;
1031                                                 /* increment to next byte */
1032                                                 ptr_data++;
1033
1034                                                 /* length */
1035                                                 prop_len = *ptr_data;
1036                                                 dbg("prop_len: %02x", prop_len);
1037
1038                                                 /* skip data */
1039                                                 ptr_data = ptr_data + prop_len + 1;
1040                                         } else {
1041                                                 dbg("INVALID FCP received - DEbug!");
1042                                         }
1043
1044                                         /* life cycle status integer [8A][length:0x01][status]*/
1045                                         /*
1046                                          status info b8~b1
1047                                          00000000 : No information given
1048                                          00000001 : creation state
1049                                          00000011 : initialization state
1050                                          000001-1 : operation state -activated
1051                                          000001-0 : operation state -deactivated
1052                                          000011-- : Termination state
1053                                          b8~b5 !=0, b4~b1=X : Proprietary
1054                                          Any other value : RFU
1055                                          */
1056                                         if (*ptr_data == 0x8A) {
1057                                                 /* increment to next byte */
1058                                                 ptr_data++;
1059                                                 /* length - value 1 */
1060                                                 ptr_data++;
1061
1062                                                 switch (*ptr_data) {
1063                                                 case 0x04:
1064                                                 case 0x06:
1065                                                         dbg("<RX> operation state -deactivated");
1066                                                         ptr_data++;
1067                                                         break;
1068
1069                                                 case 0x05:
1070                                                 case 0x07:
1071                                                         dbg("<RX> operation state -activated");
1072                                                         ptr_data++;
1073                                                         break;
1074
1075                                                 default:
1076                                                         dbg("<RX> DEBUG! LIFE CYCLE STATUS =[0x%x]", *ptr_data);
1077                                                         ptr_data++;
1078                                                         break;
1079                                                 }
1080                                         }
1081
1082                                         /* related to security attributes : currently not handled*/
1083                                         if (*ptr_data == 0x86 || *ptr_data == 0x8B || *ptr_data == 0x8C || *ptr_data == 0xAB) {
1084                                                 /* increment to next byte */
1085                                                 ptr_data++;
1086                                                 /* if tag length is 3 */
1087                                                 if (*ptr_data == 0x03) {
1088                                                         /* increment to next byte */
1089                                                         ptr_data++;
1090                                                         /* EFARR file id */
1091                                                         memcpy(&arr_file_id, ptr_data, 2);
1092                                                         /* swap byes */
1093                                                         SWAPBYTES16(arr_file_id);
1094                                                         ptr_data = ptr_data + 2;
1095                                                         arr_file_id_rec_num = *ptr_data++;
1096                                                 } else {
1097                                                         /* if tag length is not 3 */
1098                                                         /* ignoring bytes       */
1099                                                         // ptr_data = ptr_data + 4;
1100                                                         dbg("Useless security attributes, so jump to next tag");
1101                                                         ptr_data = ptr_data + (*ptr_data + 1);
1102                                                 }
1103                                         } else {
1104                                                 dbg("INVALID FCP received[0x%x] - DEbug!", *ptr_data);
1105                                                 tcore_at_tok_free(tokens);
1106                                                 g_free(recordData);
1107                                                 return;
1108                                         }
1109
1110                                         dbg("Current ptr_data value is [%x]", *ptr_data);
1111
1112                                         /* file size excluding structural info*/
1113                                         if (*ptr_data == 0x80) {
1114                                                 /* for EF file size is body of file and for Linear or cyclic it is
1115                                                  * number of recXsizeof(one record)
1116                                                  */
1117                                                 /* increment to next byte */
1118                                                 ptr_data++;
1119                                                 /* length is 1 byte - value is 2 bytes or more */
1120                                                 ptr_data++;
1121                                                 memcpy(&file_size, ptr_data, 2);
1122                                                 /* swap bytes */
1123                                                 SWAPBYTES16(file_size);
1124                                                 ptr_data = ptr_data + 2;
1125                                         } else {
1126                                                 dbg("INVALID FCP received - DEbug!");
1127                                                 tcore_at_tok_free(tokens);
1128                                                 g_free(recordData);
1129                                                 return;
1130                                         }
1131
1132                                         /* total file size including structural info*/
1133                                         if (*ptr_data == 0x81) {
1134                                                 int len;
1135                                                 /* increment to next byte */
1136                                                 ptr_data++;
1137                                                 /* length */
1138                                                 len = *ptr_data;
1139                                                 /* ignored bytes */
1140                                                 ptr_data = ptr_data + 3;
1141                                         } else {
1142                                                 dbg("INVALID FCP received - DEbug!");
1143                                                 /* 0x81 is optional tag?? check out! so do not return -1 from here! */
1144                                                 /* return -1; */
1145                                         }
1146                                         /*short file identifier ignored*/
1147                                         if (*ptr_data == 0x88) {
1148                                                 dbg("0x88: Do Nothing");
1149                                                 /*DO NOTHING*/
1150                                         }
1151                                 } else {
1152                                         dbg("INVALID FCP received - DEbug!");
1153                                         tcore_at_tok_free(tokens);
1154                                         g_free(recordData);
1155                                         return;
1156                                 }
1157                         } else if (tcore_sim_get_type(co_sim) == SIM_TYPE_GSM) {
1158                                 unsigned char gsm_specific_file_data_len = 0;
1159                                 /*      ignore RFU byte1 and byte2 */
1160                                 ptr_data++;
1161                                 ptr_data++;
1162                                 /*      file size */
1163                                 // file_size = p_info->response_len;
1164                                 memcpy(&file_size, ptr_data, 2);
1165                                 /* swap bytes */
1166                                 SWAPBYTES16(file_size);
1167                                 /*      parsed file size */
1168                                 ptr_data = ptr_data + 2;
1169                                 /* file id */
1170                                 memcpy(&file_id, ptr_data, 2);
1171                                 SWAPBYTES16(file_id);
1172                                 dbg("FILE id --> [%x]", file_id);
1173                                 ptr_data = ptr_data + 2;
1174                                 /* save file type - transparent, linear fixed or cyclic */
1175                                 file_type_tag = (*(ptr_data + 7));
1176
1177                                 switch (*ptr_data) {
1178                                 case 0x0:
1179                                         /* RFU file type */
1180                                         dbg("RFU file type- not handled - Debug!");
1181                                         break;
1182
1183                                 case 0x1:
1184                                         /* MF file type */
1185                                         dbg("MF file type - not handled - Debug!");
1186                                         break;
1187
1188                                 case 0x2:
1189                                         /* DF file type */
1190                                         dbg("DF file type - not handled - Debug!");
1191                                         break;
1192
1193                                 case 0x4:
1194                                         /* EF file type */
1195                                         dbg("EF file type [%d] ", file_type_tag);
1196                                         /*      increment to next byte */
1197                                         ptr_data++;
1198
1199                                         if (file_type_tag == 0x00 || file_type_tag == 0x01) {
1200                                                 /* increament to next byte as this byte is RFU */
1201                                                 ptr_data++;
1202                                                 file_type =
1203                                                         (file_type_tag == 0x00) ? SIM_FTYPE_TRANSPARENT : SIM_FTYPE_LINEAR_FIXED;
1204                                         } else {
1205                                                 /* increment to next byte */
1206                                                 ptr_data++;
1207                                                 /*      For a cyclic EF all bits except bit 7 are RFU; b7=1 indicates that */
1208                                                 /* the INCREASE command is allowed on the selected cyclic file. */
1209                                                 file_type = SIM_FTYPE_CYCLIC;
1210                                         }
1211                                         /* bytes 9 to 11 give SIM file access conditions */
1212                                         ptr_data++;
1213                                         /* byte 10 has one nibble that is RF U and another for INCREASE which is not used currently */
1214                                         ptr_data++;
1215                                         /* byte 11 is invalidate and rehabilate nibbles */
1216                                         ptr_data++;
1217                                         /* byte 12 - file status */
1218                                         ptr_data++;
1219                                         /* byte 13 - GSM specific data */
1220                                         gsm_specific_file_data_len = *ptr_data;
1221                                         ptr_data++;
1222                                         /*      byte 14 - structure of EF - transparent or linear or cyclic , already saved above */
1223                                         ptr_data++;
1224                                         /* byte 15 - length of record for linear and cyclic , for transparent it is set to 0x00. */
1225                                         record_len = *ptr_data;
1226                                         dbg("record length[%d], file size[%d]", record_len, file_size);
1227
1228                                         if (record_len != 0)
1229                                                 num_of_records = (file_size / record_len);
1230
1231                                         dbg("Number of records [%d]", num_of_records);
1232                                         break;
1233
1234                                 default:
1235                                         dbg("not handled file type");
1236                                         break;
1237                                 }
1238                         } else {
1239                                 dbg("Card Type - UNKNOWN [%d]", tcore_sim_get_type(co_sim));
1240                         }
1241
1242                         dbg("req ef[0x%x] resp ef[0x%x] size[%ld] Type[0x%x] NumOfRecords[%ld] RecordLen[%ld]",
1243                                 file_meta->file_id, file_id, file_size, file_type, num_of_records, record_len);
1244
1245                         file_meta->file_type = file_type;
1246                         file_meta->data_size = file_size;
1247                         file_meta->rec_length = record_len;
1248                         file_meta->rec_count = num_of_records;
1249                         file_meta->current_index = 0; // reset for new record type EF
1250                         rt = SIM_ACCESS_SUCCESS;
1251                         g_free(recordData);
1252                 } else {
1253                         /*2. SIM access fail case*/
1254                         dbg("error to get ef[0x%x]", file_meta->file_id);
1255                         dbg("error to get ef[0x%x] (file_meta->file_id) ", file_meta->file_id);
1256                         rt = _decode_status_word(sw1, sw2);
1257                 }
1258                 ur = tcore_user_request_ref(ur);
1259
1260                 dbg("Calling _next_from_get_file_info");
1261                 _next_from_get_file_info(co_sim, ur, file_meta->file_id, rt);
1262                 tcore_at_tok_free(tokens);
1263         } else {
1264                 dbg("RESPONSE NOK");
1265                 dbg("error to get ef[0x%x]", file_meta->file_id);
1266                 dbg("error to get ef[0x%x] (file_meta->file_id) ", file_meta->file_id);
1267                 rt = SIM_ACCESS_FAILED;
1268
1269                 ur = tcore_user_request_ref(ur);
1270                 _next_from_get_file_info(co_sim, ur, file_meta->file_id, rt);
1271         }
1272         dbg("Exit");
1273 }
1274
1275 static void _response_get_file_data(TcorePending *p, int data_len, const void *data, void *user_data)
1276 {
1277         const TcoreATResponse *resp = data;
1278         UserRequest *ur = NULL;
1279         CoreObject *co_sim = NULL;
1280         struct s_sim_property *file_meta = NULL;
1281         GSList *tokens = NULL;
1282         enum tel_sim_access_result rt;
1283         gboolean dr = FALSE;
1284         const char *line = NULL;
1285         char *res = NULL;
1286         char *tmp = NULL;
1287         int res_len;
1288         int sw1 = 0;
1289         int sw2 = 0;
1290
1291         dbg("Entry");
1292
1293         co_sim = tcore_pending_ref_core_object(p);
1294         ur = tcore_pending_ref_user_request(p);
1295         file_meta = (struct s_sim_property *)tcore_user_request_ref_metainfo(ur, NULL);
1296
1297         if (resp->success > 0) {
1298                 dbg("RESPONSE OK");
1299                 if (resp->lines) {
1300                         line = (const char *)resp->lines->data;
1301                         tokens = tcore_at_tok_new(line);
1302                         if (g_slist_length(tokens) != 3) {
1303                                 msg("Invalid message");
1304                                 tcore_at_tok_free(tokens);
1305                                 return;
1306                         }
1307                 }
1308                 sw1 = atoi(g_slist_nth_data(tokens, 0));
1309                 sw2 = atoi(g_slist_nth_data(tokens, 1));
1310                 res = g_slist_nth_data(tokens, 2);
1311
1312                 tmp = util_removeQuotes(res);
1313                 res = util_hexStringToBytes(tmp);
1314                 res_len = strlen((const char *)res);
1315                 dbg("Response: [%s] Response length: [%d]", res, res_len);
1316
1317                 if ((sw1 == 0x90 && sw2 == 0x00) || sw1 == 0x91) {
1318                         rt = SIM_ACCESS_SUCCESS;
1319                         file_meta->files.result = rt;
1320
1321                         dbg("File ID: [0x%x]", file_meta->file_id);
1322                         switch (file_meta->file_id) {
1323                         case SIM_EF_IMSI:
1324                         {
1325                                 struct tel_sim_imsi *imsi = NULL;
1326
1327                                 dbg("Data: [%s]", res);
1328                                 imsi = g_try_new0(struct tel_sim_imsi, 1);
1329                                 dr = tcore_sim_decode_imsi(imsi, (unsigned char *)res, res_len);
1330                                 if (dr == FALSE) {
1331                                         err("IMSI decoding failed");
1332                                 } else {
1333                                         _sim_check_identity(co_sim, imsi);
1334                                         tcore_sim_set_imsi(co_sim, imsi);
1335                                 }
1336
1337                                 /* Free memory */
1338                                 g_free(imsi);
1339                         }
1340                         break;
1341
1342                         case SIM_EF_ICCID:
1343                                 dr = tcore_sim_decode_iccid(&file_meta->files.data.iccid, (unsigned char *)res, res_len);
1344                         break;
1345
1346                         case SIM_EF_ELP:                        /* 2G EF - 2 bytes decoding */
1347                         case SIM_EF_USIM_LI:            /* 3G EF - 2 bytes decoding */
1348                         case SIM_EF_USIM_PL:            /* 3G EF - same as EFELP, so 2 byte decoding */
1349                         case SIM_EF_LP:                         /* 1 byte encoding */
1350                                 if ((tcore_sim_get_type(co_sim) == SIM_TYPE_GSM)
1351                                                 && (file_meta->file_id == SIM_EF_LP)) {
1352                                         /*
1353                                          * 2G LP(0x6F05) has 1 byte for each language
1354                                          */
1355                                         dr = tcore_sim_decode_lp(&file_meta->files.data.language,
1356                                                                 (unsigned char *)res, res_len);
1357                                 } else {
1358                                         /*
1359                                          * 3G LI(0x6F05)/PL(0x2F05),
1360                                          * 2G ELP(0x2F05) has 2 bytes for each language
1361                                          */
1362                                         dr = tcore_sim_decode_li(file_meta->file_id,
1363                                                                 &file_meta->files.data.language,
1364                                                                 (unsigned char *)res, res_len);
1365                                 }
1366                         break;
1367
1368                         case SIM_EF_SPN:
1369                                 dr = tcore_sim_decode_spn(&file_meta->files.data.spn,
1370                                                                 (unsigned char *)res, res_len);
1371                         break;
1372
1373                         case SIM_EF_SPDI:
1374                                 dr = tcore_sim_decode_spdi(&file_meta->files.data.spdi,
1375                                                                 (unsigned char *)res, res_len);
1376                         break;
1377
1378                         case SIM_EF_SST: //EF UST has same address
1379                         {
1380                                 struct tel_sim_service_table *svct = NULL;
1381
1382                                 svct = g_try_new0(struct tel_sim_service_table, 1);
1383                                 if (tcore_sim_get_type(co_sim) == SIM_TYPE_GSM) {
1384                                         dr = tcore_sim_decode_sst(&svct->sst , (unsigned char *)res, res_len);
1385                                 } else if (tcore_sim_get_type(co_sim) == SIM_TYPE_USIM) {
1386                                         dr = tcore_sim_decode_ust(&svct->ust , (unsigned char *)res, res_len);
1387                                 } else {
1388                                         dbg("err not handled tcore_sim_get_type(o)[%d] in here",tcore_sim_get_type(co_sim));
1389                                 }
1390
1391                                 if (dr == FALSE) {
1392                                         dbg("SST/UST decoding failed");
1393                                 } else {
1394                                         tcore_sim_set_service_table(co_sim, svct);
1395                                 }
1396
1397                                 /* Free memory */
1398                                 g_free(svct);
1399                         }
1400                         break;
1401
1402                         case SIM_EF_ECC:
1403                         {
1404                                 if (tcore_sim_get_type(co_sim) == SIM_TYPE_GSM) {
1405                                         dr = tcore_sim_decode_ecc(&file_meta->files.data.ecc, (unsigned char *)res, res_len);
1406                                 } else if (tcore_sim_get_type(co_sim) == SIM_TYPE_USIM) {
1407                                         struct tel_sim_ecc *ecc = NULL;
1408
1409                                         ecc = g_try_new0(struct tel_sim_ecc, 1);
1410                                         dbg("Index [%d]", file_meta->current_index);
1411
1412                                         dr = tcore_sim_decode_uecc(ecc, (unsigned char *)res, res_len);
1413                                         if (dr == TRUE) {
1414                                                 memcpy(&file_meta->files.data.ecc.ecc[file_meta->files.data.ecc.ecc_count], ecc, sizeof(struct tel_sim_ecc));
1415                                                 file_meta->files.data.ecc.ecc_count++;
1416                                         }
1417
1418                                         /* Free memory */
1419                                         g_free(ecc);
1420                                 } else {
1421                                         dbg("Unknown/Unsupported SIM Type: [%d]", tcore_sim_get_type(co_sim));
1422                                 }
1423                         }
1424                         break;
1425
1426                         case SIM_EF_MSISDN:
1427                         {
1428                                 struct tel_sim_msisdn *msisdn = NULL;
1429
1430                                 dbg("Index [%d]", file_meta->current_index);
1431                                 msisdn = g_try_new0(struct tel_sim_msisdn, 1);
1432                                 dr = tcore_sim_decode_msisdn(msisdn, (unsigned char *)res, res_len);
1433                                 if (dr == TRUE) {
1434                                         memcpy(&file_meta->files.data.msisdn_list.msisdn[file_meta->files.data.msisdn_list.count],
1435                                                                 msisdn, sizeof(struct tel_sim_msisdn));
1436
1437                                         file_meta->files.data.msisdn_list.count++;
1438                                 }
1439
1440                                 /* Free memory */
1441                                 g_free(msisdn);
1442                         }
1443                         break;
1444
1445                         case SIM_EF_OPL:
1446                         {
1447                                 struct tel_sim_opl *opl = NULL;
1448
1449                                 dbg("decode w/ index [%d]", file_meta->current_index);
1450                                 opl = g_try_new0(struct tel_sim_opl, 1);
1451
1452                                 dr = tcore_sim_decode_opl(opl, (unsigned char *)res, res_len);
1453                                 if (dr == TRUE) {
1454                                         memcpy(&file_meta->files.data.opl.opl[file_meta->files.data.opl.opl_count],
1455                                                         opl, sizeof(struct tel_sim_opl));
1456
1457                                         file_meta->files.data.opl.opl_count++;
1458                                 }
1459
1460                                 /* Free memory */
1461                                 g_free(opl);
1462                         }
1463                         break;
1464
1465                         case SIM_EF_PNN:
1466                         {
1467                                 struct tel_sim_pnn *pnn = NULL;
1468
1469                                 dbg("decode w/ index [%d]", file_meta->current_index);
1470                                 pnn = g_try_new0(struct tel_sim_pnn, 1);
1471
1472                                 dr = tcore_sim_decode_pnn(pnn, (unsigned char *)res, res_len);
1473                                 if (dr == TRUE) {
1474                                         memcpy(&file_meta->files.data.pnn.pnn[file_meta->files.data.pnn.pnn_count],
1475                                                                 pnn, sizeof(struct tel_sim_pnn));
1476
1477                                         file_meta->files.data.pnn.pnn_count++;
1478                                 }
1479
1480                                 /* Free memory */
1481                                 g_free(pnn);
1482                         }
1483                         break;
1484
1485                         case SIM_EF_OPLMN_ACT:
1486                                 dr = tcore_sim_decode_oplmnwact(&file_meta->files.data.opwa,
1487                                                                                 (unsigned char *)res, res_len);
1488                         break;
1489
1490                         case SIM_EF_CPHS_CUSTOMER_SERVICE_PROFILE:
1491                                 /*dr = tcore_sim_decode_csp(&po->p_cphs->csp,
1492                                                                                 p_data->response, p_data->response_len);*/
1493                         break;
1494
1495                         case SIM_EF_USIM_MBI: //linear type
1496                         {
1497                                 struct tel_sim_mbi *mbi = NULL;
1498
1499                                 mbi = g_try_new0(struct tel_sim_mbi, 1);
1500                                 dr = tcore_sim_decode_mbi(mbi, (unsigned char *)res, res_len);
1501                                 if (dr == TRUE) {
1502                                         memcpy(&file_meta->mbi_list.mbi[file_meta->mbi_list.profile_count],
1503                                                                                 mbi, sizeof(struct tel_sim_mbi));
1504                                         file_meta->mbi_list.profile_count++;
1505
1506                                         dbg("mbi count[%d]", file_meta->mbi_list.profile_count);
1507                                         dbg("voice_index[%d]", file_meta->mbi_list.mbi[file_meta->mbi_list.profile_count -1].voice_index);
1508                                         dbg("fax_index[%d]", file_meta->mbi_list.mbi[file_meta->mbi_list.profile_count -1].fax_index);
1509                                         dbg("email_index[%d]", file_meta->mbi_list.mbi[file_meta->mbi_list.profile_count -1].email_index);
1510                                         dbg("other_index[%d]", file_meta->mbi_list.mbi[file_meta->mbi_list.profile_count -1].other_index);
1511                                         dbg("video_index[%d]", file_meta->mbi_list.mbi[file_meta->mbi_list.profile_count -1].video_index);
1512                                 }
1513
1514                                 /* Free memory */
1515                                 g_free(mbi);
1516                         }
1517                         break;
1518
1519                         case SIM_EF_CPHS_MAILBOX_NUMBERS: // linear type
1520                         case SIM_EF_MBDN: //linear type
1521                                 dr = tcore_sim_decode_xdn(&file_meta->mb_list[file_meta->current_index-1].number_info,
1522                                                                         (unsigned char *)res, res_len);
1523                                 file_meta->mb_list[file_meta->current_index-1].rec_index = file_meta->current_index;
1524                         break;
1525
1526                         case SIM_EF_CPHS_VOICE_MSG_WAITING: // transparent type
1527                                 dr = tcore_sim_decode_vmwf(&file_meta->files.data.mw.cphs_mw,
1528                                                                         (unsigned char *)res, res_len);
1529                         break;
1530
1531                         case SIM_EF_USIM_MWIS: //linear type
1532                         {
1533                                 struct tel_sim_mw *mw = NULL;
1534
1535                                 mw = g_try_new0(struct tel_sim_mw, 1);
1536
1537                                 dr = tcore_sim_decode_mwis(mw, (unsigned char *)res, res_len);
1538                                 if (dr == TRUE) {
1539                                         memcpy(&file_meta->files.data.mw.mw_list.mw[file_meta->files.data.mw.mw_list.profile_count], mw, sizeof(struct tel_sim_mw));
1540                                         file_meta->files.data.mw.mw_list.mw[file_meta->files.data.mw.mw_list.profile_count].rec_index = file_meta->current_index;
1541                                         file_meta->files.data.mw.mw_list.profile_count++;
1542                                 }
1543
1544                                 /* Free memory */
1545                                 g_free(mw);
1546                         }
1547                         break;
1548
1549                         case SIM_EF_CPHS_CALL_FORWARD_FLAGS: //transparent type
1550                                 dr = tcore_sim_decode_cff(&file_meta->files.data.cf.cphs_cf,
1551                                                                         (unsigned char *)res, res_len);
1552                         break;
1553
1554                         case SIM_EF_USIM_CFIS: //linear type
1555                         {
1556                                 struct tel_sim_cfis *cf = NULL;
1557
1558                                 cf = g_try_new0(struct tel_sim_cfis, 1);
1559                                 dr = tcore_sim_decode_cfis(cf, (unsigned char *)res, res_len);
1560                                 if (dr == TRUE) {
1561                                         memcpy(&file_meta->files.data.cf.cf_list.cf[file_meta->files.data.cf.cf_list.profile_count],
1562                                                                         cf, sizeof(struct tel_sim_cfis));
1563
1564                                         file_meta->files.data.cf.cf_list.cf[file_meta->files.data.cf.cf_list.profile_count].rec_index = file_meta->current_index;
1565                                         file_meta->files.data.cf.cf_list.profile_count++;
1566                                 }
1567
1568                                 /* Free memory */
1569                                 g_free(cf);
1570                         }
1571                         break;
1572
1573                         case SIM_EF_CPHS_SERVICE_STRING_TABLE:
1574                                 dbg("not handled -SIM_EF_CPHS_SERVICE_STRING_TABLE ");
1575                         break;
1576
1577                         case SIM_EF_CPHS_OPERATOR_NAME_STRING:
1578                                 dr = tcore_sim_decode_ons((unsigned char*)&file_meta->files.data.cphs_net.full_name,
1579                                                                         (unsigned char *)res, res_len);
1580                                 dbg("file_meta->files.result[%d],file_meta->files.data.cphs_net.full_name[%s]",
1581                                                 file_meta->files.result, file_meta->files.data.cphs_net.full_name);
1582                         break;
1583
1584                         case SIM_EF_CPHS_DYNAMICFLAGS:
1585                                 /*dr = tcore_sim_decode_dynamic_flag(&po->p_cphs->dflagsinfo,
1586                                                                                 p_data->response, p_data->response_len);*/
1587                         break;
1588
1589                         case SIM_EF_CPHS_DYNAMIC2FLAG:
1590                                 /*dr = tcore_sim_decode_dynamic2_flag(&po->p_cphs->d2flagsinfo, p_data->response,
1591                                                                                 p_data->response_len);*/
1592                         break;
1593
1594                         case SIM_EF_CPHS_CPHS_INFO:
1595                                 dr = tcore_sim_decode_cphs_info(&file_meta->files.data.cphs,
1596                                                                                 (unsigned char *)res, res_len);
1597                         break;
1598
1599                         case SIM_EF_CPHS_OPERATOR_NAME_SHORT_FORM_STRING:
1600                                 dr = tcore_sim_decode_short_ons((unsigned char*)&file_meta->files.data.cphs_net.short_name,
1601                                                                                 (unsigned char *)res, res_len);
1602                         break;
1603
1604                         case SIM_EF_CPHS_INFORMATION_NUMBERS:
1605                                 /*dr = tcore_sim_decode_information_number(&po->p_cphs->infn, p_data->response, p_data->response_len);*/
1606                         break;
1607
1608                         default:
1609                                 dbg("File Decoding Failed - not handled File[0x%x]", file_meta->file_id);
1610                                 dr = 0;
1611                         break;
1612                         }
1613                 } else {
1614                         rt = _decode_status_word(sw1, sw2);
1615                         file_meta->files.result = rt;
1616                 }
1617
1618                 /* Free memory */
1619                 g_free(tmp);
1620                 g_free(res);
1621
1622                 /* Free tokens */
1623                 tcore_at_tok_free(tokens);
1624         } else {
1625                 dbg("RESPONSE NOK");
1626                 dbg("Error - File ID: [0x%x]", file_meta->file_id);
1627                 rt = SIM_ACCESS_FAILED;
1628         }
1629
1630         /* Reference User Request */
1631         ur = tcore_user_request_ref(ur);
1632
1633         /* Get File data */
1634         _next_from_get_file_data(tcore_pending_ref_core_object(p), ur, rt, dr);
1635
1636         dbg("Exit");
1637 }
1638
1639 static void _on_response_get_retry_count(TcorePending *p, int data_len, const void *data, void *user_data)
1640 {
1641         const TcoreATResponse *resp = data;
1642         UserRequest *ur = NULL;
1643         CoreObject *co_sim = NULL;
1644         struct s_sim_property *sp = NULL;
1645         GSList *tokens = NULL;
1646         const char *line = NULL;
1647         int lock_type = 0;
1648         int attempts_left = 0;
1649         int time_penalty = 0;
1650
1651         dbg("Entry");
1652
1653         co_sim = tcore_pending_ref_core_object(p);
1654         sp = tcore_sim_ref_userdata(co_sim);
1655         ur = tcore_pending_ref_user_request(p);
1656
1657         if (resp->success > 0) {
1658                 dbg("RESPONSE OK");
1659                 if (resp->lines) {
1660                         line = (const char *)resp->lines->data;
1661                         tokens = tcore_at_tok_new(line);
1662                         if (g_slist_length(tokens) < 3) {
1663                                 msg("Invalid message");
1664                                 tcore_at_tok_free(tokens);
1665                                 return;
1666                         }
1667                 }
1668                 lock_type = atoi(g_slist_nth_data(tokens, 0));
1669                 attempts_left = atoi(g_slist_nth_data(tokens, 1));
1670                 time_penalty = atoi(g_slist_nth_data(tokens, 2));
1671
1672                 dbg("lock_type = %d, attempts_left = %d, time_penalty = %d",
1673                         lock_type, attempts_left, time_penalty);
1674
1675                 switch (sp->current_sec_op) {
1676                 case SEC_PIN1_VERIFY:
1677                 case SEC_PIN2_VERIFY:
1678                 case SEC_SIM_VERIFY:
1679                 case SEC_ADM_VERIFY:
1680                 {
1681                         struct tresp_sim_verify_pins v_pin = {0, };
1682
1683                         v_pin.result = SIM_INCORRECT_PASSWORD;
1684                         v_pin.pin_type = _sim_get_current_pin_facility(sp->current_sec_op);
1685                         v_pin.retry_count = attempts_left;
1686                         tcore_user_request_send_response(ur, _find_resp_command(ur),
1687                                                                                          sizeof(struct tresp_sim_verify_pins), &v_pin);
1688                 }
1689                 break;
1690
1691                 case SEC_PUK1_VERIFY:
1692                 case SEC_PUK2_VERIFY:
1693                 {
1694                         struct tresp_sim_verify_puks v_puk = {0, };
1695
1696                         v_puk.result = SIM_INCORRECT_PASSWORD;
1697                         v_puk.pin_type = _sim_get_current_pin_facility(sp->current_sec_op);
1698                         v_puk.retry_count = attempts_left;
1699                         tcore_user_request_send_response(ur, _find_resp_command(ur),
1700                                                                                          sizeof(struct tresp_sim_verify_puks), &v_puk);
1701                 }
1702                 break;
1703
1704                 case SEC_PIN1_CHANGE:
1705                 case SEC_PIN2_CHANGE:
1706                 {
1707                         struct tresp_sim_change_pins change_pin = {0, };
1708
1709                         change_pin.result = SIM_INCORRECT_PASSWORD;
1710                         change_pin.pin_type = _sim_get_current_pin_facility(sp->current_sec_op);
1711                         change_pin.retry_count = attempts_left;
1712                         tcore_user_request_send_response(ur, _find_resp_command(ur),
1713                                                                                          sizeof(struct tresp_sim_change_pins), &change_pin);
1714                 }
1715                 break;
1716
1717                 case SEC_PIN1_DISABLE:
1718                 case SEC_PIN2_DISABLE:
1719                 case SEC_FDN_DISABLE:
1720                 case SEC_SIM_DISABLE:
1721                 case SEC_NET_DISABLE:
1722                 case SEC_NS_DISABLE:
1723                 case SEC_SP_DISABLE:
1724                 case SEC_CP_DISABLE:
1725                 {
1726                         struct tresp_sim_disable_facility dis_facility = {0, };
1727
1728                         dis_facility.result = SIM_INCORRECT_PASSWORD;
1729                         dis_facility.type = _sim_get_current_pin_facility(sp->current_sec_op);
1730                         dis_facility.retry_count = attempts_left;
1731                         tcore_user_request_send_response(ur, _find_resp_command(ur),
1732                                                                                          sizeof(struct tresp_sim_disable_facility), &dis_facility);
1733                 }
1734                 break;
1735
1736                 case SEC_PIN1_ENABLE:
1737                 case SEC_PIN2_ENABLE:
1738                 case SEC_FDN_ENABLE:
1739                 case SEC_SIM_ENABLE:
1740                 case SEC_NET_ENABLE:
1741                 case SEC_NS_ENABLE:
1742                 case SEC_SP_ENABLE:
1743                 case SEC_CP_ENABLE:
1744                 {
1745                         struct tresp_sim_enable_facility en_facility = {0, };
1746
1747                         en_facility.result = SIM_INCORRECT_PASSWORD;
1748                         en_facility.type = _sim_get_current_pin_facility(sp->current_sec_op);
1749                         en_facility.retry_count = attempts_left;
1750                         tcore_user_request_send_response(ur, _find_resp_command(ur),
1751                                                                                          sizeof(struct tresp_sim_enable_facility), &en_facility);
1752                 }
1753                 break;
1754
1755                 default:
1756                         dbg("not handled sec op[%d]", sp->current_sec_op);
1757                 break;
1758                 }
1759
1760                 /* Free tokens */
1761                 tcore_at_tok_free(tokens);
1762         }
1763
1764         dbg("Exit");
1765 }
1766
1767 static gboolean _get_sim_type(CoreObject *o)
1768 {
1769         TcoreHal *hal = NULL;
1770         TcoreATRequest *req = NULL;
1771         TcorePending *pending = NULL;
1772         UserRequest *ur = NULL;
1773         char *cmd_str = NULL;
1774
1775         dbg("Entry");
1776
1777         hal = tcore_object_get_hal(o);
1778         pending = tcore_pending_new(o, 0);
1779
1780         cmd_str = g_strdup_printf("AT+XUICC?");
1781         req = tcore_at_request_new(cmd_str, "+XUICC:", TCORE_AT_SINGLELINE);
1782         g_free(cmd_str);
1783
1784         dbg("Command: [%s] Prefix(if any): [%s] Command length: [%d]",
1785                                 req->cmd, req->prefix, strlen(req->cmd));
1786
1787         tcore_pending_set_request_data(pending, 0, req);
1788         tcore_pending_set_response_callback(pending, _response_get_sim_type, hal);
1789         tcore_pending_link_user_request(pending, ur);
1790         tcore_hal_send_request(hal, pending);
1791
1792         dbg("Exit");
1793         return TRUE;
1794 }
1795
1796 static TReturn _get_file_info(CoreObject *o, UserRequest *ur, const enum tel_sim_file_id ef)
1797 {
1798         TcoreHal *hal = NULL;
1799         TcorePending *pending = NULL;
1800         struct s_sim_property file_meta = {0, };
1801         char *cmd_str = NULL;
1802         TReturn ret = TCORE_RETURN_FAILURE;
1803         int trt = 0;
1804
1805         dbg("Entry");
1806
1807         file_meta.file_id = ef;
1808         dbg("file_meta.file_id: [0x%02x]", file_meta.file_id);
1809         hal = tcore_object_get_hal(o);
1810         dbg("hal: %x", hal);
1811
1812         trt = tcore_user_request_set_metainfo(ur, sizeof(struct s_sim_property), &file_meta);
1813         dbg("trt[%d]", trt);
1814         cmd_str = g_strdup_printf("AT+CRSM=192, %d", ef);      /*command - 192 : GET RESPONSE*/
1815         dbg("Command: [%s] Command length: [%d]", cmd_str, strlen(cmd_str));
1816
1817         pending = tcore_at_pending_new(o, cmd_str, "+CRSM:", TCORE_AT_SINGLELINE, _response_get_file_info, NULL);
1818         tcore_pending_link_user_request(pending, ur);
1819         ret = tcore_hal_send_request(hal, pending);
1820         if (TCORE_RETURN_SUCCESS != ret) {
1821                 tcore_user_request_free(ur);
1822         }
1823
1824         g_free(cmd_str);
1825         dbg("Exit");
1826         return TCORE_RETURN_SUCCESS;
1827 }
1828
1829 static gboolean _get_file_data(CoreObject *o, UserRequest *ur, const enum tel_sim_file_id ef, const int offset, const int length)
1830 {
1831         TcoreHal *hal = NULL;
1832         TcoreATRequest *req = NULL;
1833         TcorePending *pending = NULL;
1834         char *cmd_str = NULL;
1835         int p1 = 0;
1836         int p2 = 0;
1837         int p3 = 0;
1838
1839         dbg("Entry");
1840         hal = tcore_object_get_hal(o);
1841         pending = tcore_pending_new(o, 0);
1842
1843         dbg("file_id: %x", ef);
1844
1845         p1 = (unsigned char) (offset & 0xFF00) >> 8;
1846         p2 = (unsigned char) offset & 0x00FF; // offset low
1847         p3 = (unsigned char) length;
1848
1849         cmd_str = g_strdup_printf("AT+CRSM=176, %d, %d, %d, %d", ef, p1, p2, p3);     /*command - 176 : READ BINARY*/
1850
1851         req = tcore_at_request_new(cmd_str, "+CRSM:", TCORE_AT_SINGLELINE);
1852         g_free(cmd_str);
1853
1854         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
1855                                 req->cmd, req->prefix, strlen(req->cmd));
1856
1857         tcore_pending_set_request_data(pending, 0, req);
1858         tcore_pending_set_response_callback(pending, _response_get_file_data, hal);
1859         tcore_pending_link_user_request(pending, ur);
1860         tcore_hal_send_request(hal, pending);
1861
1862         dbg("Exit");
1863         return TRUE;
1864 }
1865
1866 static gboolean _get_file_record(CoreObject *o, UserRequest *ur, const enum tel_sim_file_id ef, const int index, const int length)
1867 {
1868         TcoreHal *hal = NULL;
1869         TcoreATRequest *req = NULL;
1870         TcorePending *pending = NULL;
1871         char *cmd_str = NULL;
1872         int p1 = 0;
1873         int p2 = 0;
1874         int p3 = 0;
1875
1876         dbg("Entry");
1877
1878         hal = tcore_object_get_hal(o);
1879         pending = tcore_pending_new(o, 0);
1880
1881         p1 = (unsigned char) index;
1882         p2 = (unsigned char) 0x04;    /* 0x4 for absolute mode */
1883         p3 = (unsigned char) length;
1884
1885         cmd_str = g_strdup_printf("AT+CRSM=178, %d, %d, %d, %d", ef, p1, p2, p3);     /*command - 178 : READ RECORD*/
1886
1887         req = tcore_at_request_new(cmd_str, "+CRSM:", TCORE_AT_SINGLELINE);
1888         g_free(cmd_str);
1889
1890         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
1891                                 req->cmd, req->prefix, strlen(req->cmd));
1892
1893         tcore_pending_set_request_data(pending, 0, req);
1894         tcore_pending_set_response_callback(pending, _response_get_file_data, hal);
1895         tcore_pending_link_user_request(pending, ur);
1896         tcore_hal_send_request(hal, pending);
1897
1898         dbg("Exit");
1899         return TRUE;
1900 }
1901
1902 static TReturn _get_retry_count(CoreObject *o, UserRequest *ur)
1903 {
1904         TcoreHal *hal = NULL;
1905         TcoreATRequest *req = NULL;
1906         TcorePending *pending = NULL;
1907         char *cmd_str = NULL;
1908         int lock_type = 0;
1909         struct s_sim_property *sp = NULL;
1910         const struct treq_sim_get_lock_info *req_data = NULL;
1911
1912         dbg("Entry");
1913
1914         hal = tcore_object_get_hal(o);
1915         pending = tcore_pending_new(o, 0);
1916         req_data = tcore_user_request_ref_data(ur, NULL);
1917         sp = tcore_sim_ref_userdata(o);
1918
1919         switch (sp->current_sec_op) {
1920         case SEC_PIN1_VERIFY:
1921         case SEC_PIN1_CHANGE:
1922         case SEC_PIN1_ENABLE:
1923         case SEC_PIN1_DISABLE:
1924                 lock_type = 1;
1925                 break;
1926
1927         case SEC_PIN2_VERIFY:
1928         case SEC_PIN2_CHANGE:
1929         case SEC_PIN2_ENABLE:
1930         case SEC_PIN2_DISABLE:
1931         case SEC_FDN_ENABLE:
1932         case SEC_FDN_DISABLE:
1933                 lock_type = 2;
1934                 break;
1935
1936         case SEC_PUK1_VERIFY:
1937                 lock_type = 3;
1938                 break;
1939
1940         case SEC_PUK2_VERIFY:
1941                 lock_type = 4;
1942                 break;
1943
1944         case SEC_NET_ENABLE:
1945         case SEC_NET_DISABLE:
1946                 lock_type = 5;
1947                 break;
1948
1949         case SEC_NS_ENABLE:
1950         case SEC_NS_DISABLE:
1951                 lock_type = 6;
1952                 break;
1953
1954         case SEC_SP_ENABLE:
1955         case SEC_SP_DISABLE:
1956                 lock_type = 7;
1957                 break;
1958
1959         case SEC_CP_ENABLE:
1960         case SEC_CP_DISABLE:
1961                 lock_type = 8;
1962                 break;
1963
1964         case SEC_ADM_VERIFY:
1965                 lock_type = 9;
1966                 break;
1967
1968         default:
1969                 break;
1970         }
1971
1972         cmd_str = g_strdup_printf("AT+XPINCNT=%d", lock_type);
1973         req = tcore_at_request_new(cmd_str, "+XPINCNT:", TCORE_AT_SINGLELINE);
1974         g_free(cmd_str);
1975
1976         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
1977                                 req->cmd, req->prefix, strlen(req->cmd));
1978
1979         tcore_pending_set_request_data(pending, 0, req);
1980         tcore_pending_set_response_callback(pending, _on_response_get_retry_count, hal);
1981         tcore_pending_link_user_request(pending, ur);
1982         tcore_hal_send_request(hal, pending);
1983
1984         dbg("Exit");
1985         return TCORE_RETURN_SUCCESS;
1986 }
1987
1988 static gboolean on_event_facility_lock_status(CoreObject *o, const void *event_info, void *user_data)
1989 {
1990         struct s_sim_property *sp = NULL;
1991         char *line = NULL;
1992         GSList *tokens = NULL;
1993         GSList *lines = NULL;
1994
1995         dbg("Function entry");
1996         return TRUE;
1997
1998         sp = tcore_sim_ref_userdata(o);
1999         lines = (GSList *)event_info;
2000         if (1 != g_slist_length(lines)) {
2001                 dbg("unsolicited msg but multiple line");
2002                 goto OUT;
2003         }
2004         line = (char *)(lines->data);
2005         tokens = tcore_at_tok_new(line);
2006         if (g_slist_length(tokens) != 1) {
2007                 msg("Invalid message");
2008                 tcore_at_tok_free(tokens);
2009                 return TRUE;
2010         }
2011
2012 OUT:
2013         dbg("Exit");
2014         if (NULL != tokens)
2015                 tcore_at_tok_free(tokens);
2016         return TRUE;
2017 }
2018
2019 static void notify_sms_state(TcorePlugin *plugin, CoreObject *co_sim,
2020                                 gboolean sms_ready)
2021 {
2022         Server *server = tcore_plugin_ref_server(plugin);
2023         struct tnoti_sms_ready_status sms_ready_noti;
2024         CoreObject *co_sms;
2025
2026         dbg("Entry");
2027
2028         co_sms = tcore_plugin_ref_core_object(plugin, CORE_OBJECT_TYPE_SMS);
2029         if (co_sms == NULL) {
2030                 err("Can't find SMS core object");
2031                 return;
2032         }
2033
2034         if (tcore_sms_get_ready_status(co_sms) == sms_ready)
2035                 return;
2036
2037         tcore_sms_set_ready_status(co_sms, sms_ready);
2038
2039         if (tcore_sim_get_status(co_sim) == SIM_STATUS_INIT_COMPLETED) {
2040                 sms_ready_noti.status = sms_ready;
2041                 tcore_server_send_notification(server, co_sms,
2042                                                 TNOTI_SMS_DEVICE_READY,
2043                                                 sizeof(sms_ready_noti),
2044                                                 &sms_ready_noti);
2045         }
2046
2047         dbg("Exit");
2048 }
2049
2050 static gboolean on_event_pin_status(CoreObject *o, const void *event_info, void *user_data)
2051 {
2052         TcorePlugin *plugin = tcore_object_ref_plugin(o);
2053         enum tel_sim_status sim_status = SIM_STATUS_INITIALIZING;
2054         GSList *tokens = NULL;
2055         GSList *lines;
2056         const char *line;
2057         int sim_state = 0;
2058         int sms_state = 0;
2059
2060         dbg("Entry");
2061
2062         lines = (GSList *)event_info;
2063         if (g_slist_length(lines) != 1) {
2064                 err("Unsolicited message BUT multiple lines");
2065                 goto out;
2066         }
2067
2068         line = lines->data;
2069
2070         /* Create 'tokens' */
2071         tokens = tcore_at_tok_new(line);
2072
2073         /* SIM State */
2074         if (g_slist_length(tokens) == 4) {
2075                 sim_state = atoi(g_slist_nth_data(tokens, 1));
2076                 sms_state = atoi(g_slist_nth_data(tokens, 3));
2077                 notify_sms_state(plugin, o, (sms_state > 0));
2078         } else if (g_slist_length(tokens) == 1) {
2079                 sim_state = atoi(g_slist_nth_data(tokens, 0));
2080         } else {
2081                 err("Invalid message");
2082                 goto out;
2083         }
2084
2085         switch (sim_state) {
2086         case 0:
2087                 sim_status = SIM_STATUS_CARD_NOT_PRESENT;
2088                 dbg("NO SIM");
2089                 break;
2090         case 1:
2091                 sim_status = SIM_STATUS_PIN_REQUIRED;
2092                 dbg("PIN REQUIRED");
2093                 break;
2094         case 2:
2095                 sim_status = SIM_STATUS_INITIALIZING;
2096                 dbg("PIN DISABLED AT BOOT UP");
2097                 break;
2098         case 3:
2099                 sim_status = SIM_STATUS_INITIALIZING;
2100                 dbg("PIN VERIFIED");
2101                 break;
2102         case 4:
2103                 sim_status = SIM_STATUS_PUK_REQUIRED;
2104                 dbg("PUK REQUIRED");
2105                 break;
2106         case 5:
2107                 sim_status = SIM_STATUS_CARD_BLOCKED;
2108                 dbg("CARD PERMANENTLY BLOCKED");
2109                 break;
2110         case 6:
2111                 sim_status = SIM_STATUS_CARD_ERROR;
2112                 dbg("SIM CARD ERROR");
2113                 break;
2114         case 7:
2115                 sim_status = SIM_STATUS_INIT_COMPLETED;
2116                 dbg("SIM INIT COMPLETED");
2117                 break;
2118         case 8:
2119                 sim_status = SIM_STATUS_CARD_ERROR;
2120                 dbg("SIM CARD ERROR");
2121                 break;
2122
2123         case 9:
2124                 sim_status = SIM_STATUS_CARD_REMOVED;
2125                 dbg("SIM REMOVED");
2126                 break;
2127         case 12:
2128                 dbg("SIM SMS Ready");
2129                 notify_sms_state(plugin, o, TRUE);
2130                 goto out;
2131         case 99:
2132                 sim_status = SIM_STATUS_UNKNOWN;
2133                 dbg("SIM STATE UNKNOWN");
2134                 break;
2135         default:
2136                 err("Unknown/Unsupported SIM state: [%d]", sim_state);
2137                 break;
2138         }
2139
2140         switch (sim_status) {
2141         case SIM_STATUS_INIT_COMPLETED:
2142                 dbg("[SIM] SIM INIT COMPLETED");
2143                 if (tcore_sim_get_type(o) == SIM_TYPE_UNKNOWN) {
2144                         _get_sim_type(o);
2145                         goto out;
2146                 }
2147
2148                 break;
2149         case SIM_STATUS_CARD_REMOVED:
2150                 dbg("[SIM] SIM CARD REMOVED");
2151                 tcore_sim_set_type(o, SIM_TYPE_UNKNOWN);
2152                 break;
2153
2154         case SIM_STATUS_CARD_NOT_PRESENT:
2155                 dbg("[SIM] SIM CARD NOT PRESENT");
2156                 tcore_sim_set_type(o, SIM_TYPE_UNKNOWN);
2157                 break;
2158
2159         case SIM_STATUS_CARD_ERROR:
2160                 dbg("[SIM] SIM CARD ERROR");
2161                 tcore_sim_set_type(o, SIM_TYPE_UNKNOWN);
2162                 break;
2163
2164         default:
2165                 err("[SIM) Status: [0x%02x]", sim_status);
2166                 goto out;
2167         }
2168
2169         _sim_status_update(o, sim_status);
2170
2171 out:
2172         tcore_at_tok_free(tokens);
2173
2174         dbg("Exit");
2175         return TRUE;
2176 }
2177
2178 static void on_response_get_sim_status(TcorePending *p, int data_len, const void *data, void *user_data)
2179 {
2180         const TcoreATResponse *resp = data;
2181         CoreObject *co_sim = NULL;
2182
2183         dbg("Entry");
2184
2185         co_sim = tcore_pending_ref_core_object(p);
2186
2187         if (resp->success > 0) {
2188                 dbg("RESPONSE OK");
2189                 if (resp->lines)
2190                         on_event_pin_status(co_sim, resp->lines, NULL);
2191         } else {
2192                 dbg("RESPONSE NOK");
2193         }
2194
2195         dbg("Exit");
2196 }
2197
2198 static enum tcore_hook_return on_hook_modem_power(Server *s, CoreObject *source, enum tcore_notification_command command,
2199                                                                                           unsigned int data_len, void *data, void *user_data)
2200 {
2201         TcorePlugin *plugin = tcore_object_ref_plugin(source);
2202         CoreObject *co_sim = tcore_plugin_ref_core_object(plugin, CORE_OBJECT_TYPE_SIM);
2203
2204         if (co_sim == NULL)
2205                 return TCORE_HOOK_RETURN_CONTINUE;
2206
2207         dbg("Get SIM status");
2208
2209         sim_prepare_and_send_pending_request(co_sim, "AT+XSIMSTATE?", "+XSIMSTATE:", TCORE_AT_SINGLELINE, on_response_get_sim_status);
2210
2211         return TCORE_HOOK_RETURN_CONTINUE;
2212 }
2213
2214 static void on_response_verify_pins(TcorePending *p, int data_len, const void *data, void *user_data)
2215 {
2216         const TcoreATResponse *resp = data;
2217         UserRequest *ur = NULL;
2218         CoreObject *co_sim = NULL;
2219         struct s_sim_property *sp = NULL;
2220         GSList *tokens = NULL;
2221         struct tresp_sim_verify_pins res;
2222         GQueue *queue = NULL;
2223         const char *line;
2224         int err;
2225
2226         dbg("Entry");
2227
2228         co_sim = tcore_pending_ref_core_object(p);
2229         sp = tcore_sim_ref_userdata(co_sim);
2230         ur = tcore_pending_ref_user_request(p);
2231
2232         memset(&res, 0, sizeof(struct tresp_sim_verify_pins));
2233
2234         if (resp->success > 0) {
2235                 dbg("RESPONSE OK");
2236                 res.result = SIM_PIN_OPERATION_SUCCESS;
2237
2238                 /* Get PIN facility */
2239                 res.pin_type = _sim_get_current_pin_facility(sp->current_sec_op);
2240                 if ((res.pin_type == SIM_PTYPE_PIN1)
2241                                 || (res.pin_type == SIM_PTYPE_SIM)) {
2242                         if (tcore_sim_get_status(co_sim) != SIM_STATUS_INIT_COMPLETED) {
2243                                 /* Update SIM Status */
2244                                 _sim_status_update(co_sim, SIM_STATUS_INITIALIZING);
2245                         }
2246                 }
2247
2248                 /* Send Response */
2249                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2250                                         sizeof(struct tresp_sim_verify_pins), &res);
2251         } else {
2252                 dbg("RESPONSE NOK");
2253                 line = (const char *)resp->final_response;
2254                 tokens = tcore_at_tok_new(line);
2255                 if (g_slist_length(tokens) < 1) {
2256                         dbg("Unkown Error OR String corrupted");
2257                         res.result = TCORE_RETURN_3GPP_ERROR;
2258
2259                         /* Send Response */
2260                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2261                                                                 sizeof(struct tresp_sim_verify_pins), &res);
2262                 } else {
2263                         err = atoi(g_slist_nth_data(tokens, 0));
2264                         dbg("Error: [%d]", err);
2265
2266                         queue = tcore_object_ref_user_data(co_sim);
2267                         ur = tcore_user_request_ref(ur);
2268
2269                         /* Get retry count */
2270                         _get_retry_count(co_sim, ur);
2271                 }
2272
2273                 /* Free tokens */
2274                 tcore_at_tok_free(tokens);
2275         }
2276
2277         dbg("Exit");
2278 }
2279
2280 static void on_response_verify_puks(TcorePending *p, int data_len, const void *data, void *user_data)
2281 {
2282         const TcoreATResponse *resp = data;
2283         UserRequest *ur = NULL;
2284         CoreObject *co_sim = NULL;
2285         struct s_sim_property *sp = NULL;
2286         GSList *tokens = NULL;
2287         struct tresp_sim_verify_puks res;
2288         GQueue *queue = NULL;
2289         const char *line;
2290         int err;
2291
2292         dbg("Entry");
2293
2294         co_sim = tcore_pending_ref_core_object(p);
2295         sp = tcore_sim_ref_userdata(co_sim);
2296         ur = tcore_pending_ref_user_request(p);
2297
2298         memset(&res, 0, sizeof(struct tresp_sim_verify_pins));
2299
2300         if (resp->success > 0) {
2301                 dbg("RESPONSE OK");
2302                 res.result = SIM_PIN_OPERATION_SUCCESS;
2303                 res.pin_type = _sim_get_current_pin_facility(sp->current_sec_op);
2304
2305                 /* Send Response */
2306                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2307                                                         sizeof(struct tresp_sim_verify_pins), &res);
2308         } else {
2309                 dbg("RESPONSE NOK");
2310                 line = (const char *)resp->final_response;
2311                 tokens = tcore_at_tok_new(line);
2312
2313                 if (g_slist_length(tokens) < 1) {
2314                         dbg("Unkown Error OR String corrupted");
2315                         res.result = TCORE_RETURN_3GPP_ERROR;
2316
2317                         /* Send Response */
2318                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2319                                                         sizeof(struct tresp_sim_verify_pins), &res);
2320                 } else {
2321                         err = atoi(g_slist_nth_data(tokens, 0));
2322                         queue = tcore_object_ref_user_data(co_sim);
2323                         ur = tcore_user_request_ref(ur);
2324                         _get_retry_count(co_sim, ur);
2325                 }
2326                 tcore_at_tok_free(tokens);
2327         }
2328         dbg("Exit");
2329 }
2330
2331 static void on_response_change_pins(TcorePending *p, int data_len, const void *data, void *user_data)
2332 {
2333         const TcoreATResponse *resp = data;
2334         UserRequest *ur = NULL;
2335         CoreObject *co_sim = NULL;
2336         struct s_sim_property *sp = NULL;
2337         GSList *tokens = NULL;
2338         struct tresp_sim_change_pins res;
2339         GQueue *queue;
2340         const char *line;
2341         int err;
2342
2343         dbg("Entry");
2344
2345         co_sim = tcore_pending_ref_core_object(p);
2346         sp = tcore_sim_ref_userdata(co_sim);
2347         ur = tcore_pending_ref_user_request(p);
2348
2349         memset(&res, 0, sizeof(struct tresp_sim_change_pins));
2350
2351         if (resp->success > 0) {
2352                 dbg("RESPONSE OK");
2353                 res.result = SIM_PIN_OPERATION_SUCCESS;
2354                 res.pin_type = _sim_get_current_pin_facility(sp->current_sec_op);
2355
2356                 /* Send Response */
2357                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2358                                                         sizeof(struct tresp_sim_change_pins), &res);
2359         } else {
2360                 dbg("RESPONSE NOK");
2361                 line = (const char *)resp->final_response;
2362                 tokens = tcore_at_tok_new(line);
2363
2364                 if (g_slist_length(tokens) < 1) {
2365                         dbg("Unkown Error OR String corrupted");
2366                         res.result = TCORE_RETURN_3GPP_ERROR;
2367
2368                         /* Send Response */
2369                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2370                                                         sizeof(struct tresp_sim_change_pins), &res);
2371                 } else {
2372                         err = atoi(g_slist_nth_data(tokens, 0));
2373                         queue = tcore_object_ref_user_data(co_sim);
2374                         ur = tcore_user_request_ref(ur);
2375                         _get_retry_count(co_sim, ur);
2376                 }
2377
2378                 /* Free tokens */
2379                 tcore_at_tok_free(tokens);
2380         }
2381         dbg("Exit");
2382 }
2383
2384 static void on_response_get_facility_status(TcorePending *p, int data_len, const void *data, void *user_data)
2385 {
2386         const TcoreATResponse *resp = data;
2387         UserRequest *ur = NULL;
2388         GSList *tokens = NULL;
2389         struct tresp_sim_get_facility_status *res = user_data;
2390         const char *line;
2391
2392         dbg("Entry");
2393
2394         ur = tcore_pending_ref_user_request(p);
2395
2396         res->result = SIM_PIN_OPERATION_SUCCESS;
2397
2398         if (resp->success > 0) {
2399                 dbg("RESPONSE OK");
2400                 if (resp->lines) {
2401                         line = (const char *)resp->lines->data;
2402                         tokens = tcore_at_tok_new(line);
2403                         if (g_slist_length(tokens) != 1) {
2404                                 msg("Invalid message");
2405                                 tcore_at_tok_free(tokens);
2406                                 return;
2407                         }
2408                 }
2409                 res->b_enable = atoi(g_slist_nth_data(tokens, 0));
2410         } else {
2411                 dbg("RESPONSE NOK");
2412                 res->result = SIM_INCOMPATIBLE_PIN_OPERATION;
2413         }
2414
2415         /* Send Response */
2416         if (ur) {
2417                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2418                                                 sizeof(struct tresp_sim_get_facility_status), res);
2419         }
2420         tcore_at_tok_free(tokens);
2421         g_free(res);
2422         dbg("Exit");
2423 }
2424
2425 static void on_response_enable_facility(TcorePending *p, int data_len, const void *data, void *user_data)
2426 {
2427         const TcoreATResponse *resp = data;
2428         UserRequest *ur = NULL;
2429         CoreObject *co_sim = NULL;
2430         struct s_sim_property *sp = NULL;
2431         GSList *tokens = NULL;
2432         struct tresp_sim_enable_facility res;
2433         GQueue *queue;
2434         const char *line;
2435
2436         dbg("Entry");
2437
2438         co_sim = tcore_pending_ref_core_object(p);
2439         sp = tcore_sim_ref_userdata(co_sim);
2440         ur = tcore_pending_ref_user_request(p);
2441
2442         memset(&res, 0, sizeof(struct tresp_sim_enable_facility));
2443
2444         res.result = SIM_CARD_ERROR;
2445         res.type = _sim_get_current_pin_facility(sp->current_sec_op);
2446
2447         if (resp->success > 0) {
2448                 dbg("RESPONSE OK");
2449                 if (resp->lines) {
2450                         line = (const char *)resp->lines->data;
2451                         tokens = tcore_at_tok_new(line);
2452                         if (g_slist_length(tokens) != 1) {
2453                                 msg("Invalid message");
2454
2455                                 /* Send Response */
2456                                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2457                                                                          sizeof(struct tresp_sim_enable_facility), &res);
2458                                 tcore_at_tok_free(tokens);
2459                                 return;
2460                         }
2461                 }
2462
2463                 res.result = SIM_PIN_OPERATION_SUCCESS;
2464
2465                 /* Send Response */
2466                 if (ur) {
2467                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2468                                                                  sizeof(struct tresp_sim_enable_facility), &res);
2469                 }
2470
2471                 /* Free tokens */
2472                 tcore_at_tok_free(tokens);
2473         } else {
2474                 dbg("RESPONSE NOK");
2475                 queue = tcore_object_ref_user_data(co_sim);
2476                 ur = tcore_user_request_ref(ur);
2477                 _get_retry_count(co_sim, ur);
2478         }
2479         dbg("Exit");
2480 }
2481
2482 static void on_response_disable_facility(TcorePending *p, int data_len, const void *data, void *user_data)
2483 {
2484         const TcoreATResponse *resp = data;
2485         UserRequest *ur = NULL;
2486         CoreObject *co_sim = NULL;
2487         struct s_sim_property *sp = NULL;
2488         GSList *tokens = NULL;
2489         struct tresp_sim_disable_facility res;
2490         GQueue *queue;
2491         const char *line;
2492
2493         dbg("Entry");
2494
2495         co_sim = tcore_pending_ref_core_object(p);
2496         sp = tcore_sim_ref_userdata(co_sim);
2497         ur = tcore_pending_ref_user_request(p);
2498
2499         memset(&res, 0, sizeof(struct tresp_sim_disable_facility));
2500
2501         res.result = SIM_CARD_ERROR;
2502         res.type = _sim_get_current_pin_facility(sp->current_sec_op);
2503
2504         if (resp->success > 0) {
2505                 dbg("RESPONSE OK");
2506                 if (resp->lines) {
2507                         line = (const char *)resp->lines->data;
2508                         tokens = tcore_at_tok_new(line);
2509                         if (g_slist_length(tokens) != 1) {
2510                                 msg("Invalid message");
2511
2512                                 /* Send Response */
2513                                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2514                                                                                 sizeof(struct tresp_sim_disable_facility), &res);
2515                                 tcore_at_tok_free(tokens);
2516                                 return;
2517                         }
2518                 }
2519
2520                 res.result = SIM_PIN_OPERATION_SUCCESS;
2521                 /* Send Response */
2522                 if (ur) {
2523                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2524                                                                         sizeof(struct tresp_sim_disable_facility), &res);
2525                 }
2526
2527                 /* Free tokens */
2528                 tcore_at_tok_free(tokens);
2529         } else {
2530                 dbg("RESPONSE NOK");
2531                 queue = tcore_object_ref_user_data(co_sim);
2532                 ur = tcore_user_request_ref(ur);
2533                 _get_retry_count(co_sim, ur);
2534         }
2535         dbg("Exit");
2536 }
2537
2538 static void on_response_get_lock_info(TcorePending *p, int data_len, const void *data, void *user_data)
2539 {
2540         const TcoreATResponse *resp = data;
2541         UserRequest *ur = NULL;
2542         CoreObject *co_sim = NULL;
2543         struct s_sim_property *sp = NULL;
2544         GSList *tokens = NULL;
2545         const char *line;
2546         int lock_type;
2547         int attempts_left = 0;
2548         int time_penalty = 0;
2549
2550         dbg("Entry");
2551
2552         co_sim = tcore_pending_ref_core_object(p);
2553         sp = tcore_sim_ref_userdata(co_sim);
2554         ur = tcore_pending_ref_user_request(p);
2555
2556         if (resp->success > 0) {
2557                 dbg("RESPONSE OK");
2558                 if (resp->lines) {
2559                         line = (const char *)resp->lines->data;
2560                         dbg("Line: [%s]", line);
2561                         tokens = tcore_at_tok_new(line);
2562                         if (g_slist_length(tokens) != 3) {
2563                                 msg("Invalid message");
2564                                 tcore_at_tok_free(tokens);
2565                                 return;
2566                         }
2567                 }
2568
2569                 lock_type = atoi(g_slist_nth_data(tokens, 0));
2570                 attempts_left = atoi(g_slist_nth_data(tokens, 1));
2571                 time_penalty = atoi(g_slist_nth_data(tokens, 2));
2572
2573                 switch (sp->current_sec_op) {
2574                 case SEC_PIN1_VERIFY:
2575                 case SEC_PIN2_VERIFY:
2576                 case SEC_SIM_VERIFY:
2577                 case SEC_ADM_VERIFY:
2578                 {
2579                         struct tresp_sim_verify_pins v_pin = {0, };
2580
2581                         v_pin.result = SIM_INCORRECT_PASSWORD;
2582                         v_pin.pin_type = _sim_get_current_pin_facility(sp->current_sec_op);
2583                         v_pin.retry_count = attempts_left;
2584                         dbg("PIN Type: [0x%02x] Attempts left: [%d]",
2585                                                         v_pin.pin_type, v_pin.retry_count);
2586
2587                         /* Send Response */
2588                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2589                                                                                         sizeof(v_pin), &v_pin);
2590                 }
2591                 break;
2592
2593                 case SEC_PUK1_VERIFY:
2594                 case SEC_PUK2_VERIFY:
2595                 {
2596                         struct tresp_sim_verify_puks v_puk = {0, };
2597
2598                         v_puk.result = SIM_INCORRECT_PASSWORD;
2599                         v_puk.pin_type = _sim_get_current_pin_facility(sp->current_sec_op);
2600                         v_puk.retry_count = attempts_left;
2601                         dbg("PUK Type: [0x%02x] Attempts left: [%d]",
2602                                                         v_puk.pin_type, v_puk.retry_count);
2603
2604                         /* Send Response */
2605                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2606                                                                                         sizeof(v_puk), &v_puk);
2607                 }
2608                 break;
2609
2610                 case SEC_PIN1_CHANGE:
2611                 case SEC_PIN2_CHANGE:
2612                 {
2613                         struct tresp_sim_change_pins change_pin = {0, };
2614
2615                         change_pin.result = SIM_INCORRECT_PASSWORD;
2616                         change_pin.pin_type = _sim_get_current_pin_facility(sp->current_sec_op);
2617                         change_pin.retry_count = attempts_left;
2618                         dbg("PIN Type: [0x%02x] Attempts left: [%d]",
2619                                                         change_pin.pin_type, change_pin.retry_count);
2620
2621                         /* Send Response */
2622                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2623                                                                                         sizeof(change_pin), &change_pin);
2624                 }
2625                 break;
2626
2627                 case SEC_PIN1_DISABLE:
2628                 case SEC_PIN2_DISABLE:
2629                 case SEC_FDN_DISABLE:
2630                 case SEC_SIM_DISABLE:
2631                 case SEC_NET_DISABLE:
2632                 case SEC_NS_DISABLE:
2633                 case SEC_SP_DISABLE:
2634                 case SEC_CP_DISABLE:
2635                 {
2636                         struct tresp_sim_disable_facility dis_facility = {0, };
2637
2638                         dis_facility.result = SIM_INCORRECT_PASSWORD;
2639                         dis_facility.type = _sim_get_current_pin_facility(sp->current_sec_op);
2640                         dis_facility.retry_count = attempts_left;
2641                         dbg("Facility Type: [0x%02x] Attempts left: [%d]",
2642                                                         dis_facility.type, dis_facility.retry_count);
2643
2644                         /* Send Response */
2645                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2646                                                                                         sizeof(dis_facility), &dis_facility);
2647                 }
2648                 break;
2649
2650                 case SEC_PIN1_ENABLE:
2651                 case SEC_PIN2_ENABLE:
2652                 case SEC_FDN_ENABLE:
2653                 case SEC_SIM_ENABLE:
2654                 case SEC_NET_ENABLE:
2655                 case SEC_NS_ENABLE:
2656                 case SEC_SP_ENABLE:
2657                 case SEC_CP_ENABLE:
2658                 {
2659                         struct tresp_sim_enable_facility en_facility = {0, };
2660
2661                         en_facility.result = SIM_INCORRECT_PASSWORD;
2662                         en_facility.type = _sim_get_current_pin_facility(sp->current_sec_op);
2663                         en_facility.retry_count = attempts_left;
2664                         dbg("Facility Type: [0x%02x] Attempts left: [%d]",
2665                                                         en_facility.type, en_facility.retry_count);
2666
2667                         /* Send Response */
2668                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2669                                                                                         sizeof(en_facility), &en_facility);
2670                 }
2671                 break;
2672
2673                 default:
2674                         dbg("not handled sec op[%d]", sp->current_sec_op);
2675                         break;
2676                 }
2677
2678                 /* Free tokens */
2679                 tcore_at_tok_free(tokens);
2680         }
2681         dbg("Exit");
2682 }
2683
2684 static void on_response_update_file(TcorePending *p, int data_len, const void *data, void *user_data)
2685 {
2686         const TcoreATResponse *resp = data;
2687         UserRequest *ur = NULL;
2688         CoreObject *co_sim = NULL;
2689         struct tresp_sim_set_data resp_cf = {0, };
2690         struct tresp_sim_set_data resp_language = {0, };
2691         struct s_sim_property *sp = NULL;
2692         GSList *tokens = NULL;
2693         enum tel_sim_access_result result = SIM_CARD_ERROR;
2694         const char *line;
2695         int sw1 = 0;
2696         int sw2 = 0;
2697
2698         dbg("Entry");
2699
2700         co_sim = tcore_pending_ref_core_object(p);
2701         ur = tcore_pending_ref_user_request(p);
2702         sp = (struct s_sim_property *)tcore_user_request_ref_metainfo(ur, NULL);
2703
2704         if (resp->success > 0) {
2705                 dbg("RESPONSE OK");
2706                 if (resp->lines) {
2707                         line = (const char *)resp->lines->data;
2708                         tokens = tcore_at_tok_new(line);
2709                         if (g_slist_length(tokens) != 2) {
2710                                 msg("Invalid message");
2711                                 goto OUT;
2712                         }
2713                 }
2714                 sw1 = atoi(g_slist_nth_data(tokens, 0));
2715                 sw2 = atoi(g_slist_nth_data(tokens, 1));
2716
2717                 if ((sw1 == 0x90 && sw2 == 0x00) || sw1 == 0x91) {
2718                         result = SIM_ACCESS_SUCCESS;
2719                 } else {
2720                         result = _decode_status_word(sw1, sw2);
2721                 }
2722         } else {
2723                 dbg("RESPONSE NOK");
2724                 result = SIM_ACCESS_FAILED;
2725         }
2726 OUT:
2727         switch (sp->file_id) {
2728         case SIM_EF_CPHS_CALL_FORWARD_FLAGS:
2729         case SIM_EF_USIM_CFIS:
2730                 resp_cf.result = result;
2731
2732                 /* Send Response */
2733                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2734                                                         sizeof(struct tresp_sim_set_data), &resp_cf);
2735                 break;
2736
2737         case SIM_EF_ELP:
2738         case SIM_EF_LP:
2739         case SIM_EF_USIM_LI:
2740         case SIM_EF_USIM_PL:
2741                 resp_language.result = result;
2742
2743                 /* Send Response */
2744                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2745                                                         sizeof(struct tresp_sim_set_data), &resp_language);
2746                 break;
2747
2748         default:
2749                 dbg("Invalid File ID - %d", sp->file_id);
2750                 break;
2751         }
2752         tcore_at_tok_free(tokens);
2753         dbg("Exit");
2754 }
2755
2756 static void on_response_transmit_apdu(TcorePending *p, int data_len, const void *data, void *user_data)
2757 {
2758         const TcoreATResponse *resp = data;
2759         UserRequest *ur = NULL;
2760         CoreObject *co_sim = NULL;
2761         GSList *tokens = NULL;
2762         struct tresp_sim_transmit_apdu res;
2763         const char *line;
2764
2765         dbg("Entry");
2766
2767         co_sim = tcore_pending_ref_core_object(p);
2768         ur = tcore_pending_ref_user_request(p);
2769
2770         memset(&res, 0, sizeof(struct tresp_sim_transmit_apdu));
2771         res.result = SIM_ACCESS_FAILED;
2772
2773         if (resp->success > 0) {
2774                 dbg("RESPONSE OK");
2775                 if (resp->lines) {
2776                         char *tmp = NULL;
2777                         char *decoded_data = NULL;
2778                         line = (const char *)resp->lines->data;
2779                         tokens = tcore_at_tok_new(line);
2780                         if (g_slist_length(tokens) != 2) {
2781                                 msg("Invalid message");
2782                                 goto OUT;
2783                         }
2784                         res.apdu_resp_length = atoi(g_slist_nth_data(tokens, 0)) / 2;
2785
2786                         tmp = util_removeQuotes(g_slist_nth_data(tokens, 1));
2787                         decoded_data = util_hexStringToBytes(tmp);
2788
2789                         memcpy((char *)res.apdu_resp, decoded_data, res.apdu_resp_length);
2790                         g_free(tmp);
2791                         g_free(decoded_data);
2792                         res.result = SIM_ACCESS_SUCCESS;
2793                 }
2794         } else {
2795                 dbg("RESPONSE NOK");
2796         }
2797
2798 OUT:
2799         /* Send Response */
2800         if (ur) {
2801                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2802                                                         sizeof(struct tresp_sim_transmit_apdu), &res);
2803         }
2804         tcore_at_tok_free(tokens);
2805         dbg("Exit");
2806 }
2807
2808 static void on_response_get_atr(TcorePending *p, int data_len, const void *data, void *user_data)
2809 {
2810         const TcoreATResponse *resp = data;
2811         UserRequest *ur = NULL;
2812         GSList *tokens = NULL;
2813         struct tresp_sim_get_atr res;
2814         const char *line;
2815
2816         dbg("Entry");
2817
2818         memset(&res, 0, sizeof(struct tresp_sim_get_atr));
2819         ur = tcore_pending_ref_user_request(p);
2820
2821         res.result = SIM_ACCESS_FAILED;
2822         if (resp->success > 0) {
2823                 dbg("RESPONSE OK");
2824                 if (resp->lines) {
2825                         char *tmp = NULL;
2826                         char *decoded_data = NULL;
2827                         line = (const char *)resp->lines->data;
2828                         tokens = tcore_at_tok_new(line);
2829                         if (g_slist_length(tokens) < 1) {
2830                                 msg("Invalid message");
2831                                 goto OUT;
2832                         }
2833
2834                         tmp = util_removeQuotes(g_slist_nth_data(tokens, 0));
2835                         decoded_data = util_hexStringToBytes(tmp);
2836
2837                         res.atr_length = strlen(decoded_data);
2838                         memcpy((char *)res.atr, decoded_data, res.atr_length);
2839                         g_free(tmp);
2840                         g_free(decoded_data);
2841                         res.result = SIM_ACCESS_SUCCESS;
2842                 }
2843         } else {
2844                 dbg("RESPONSE NOK");
2845         }
2846
2847 OUT:
2848         /* Send Response */
2849         if (ur) {
2850                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2851                                                         sizeof(struct tresp_sim_get_atr), &res);
2852         }
2853         tcore_at_tok_free(tokens);
2854         dbg("Exit");
2855 }
2856
2857 static TReturn s_verify_pins(CoreObject *o, UserRequest *ur)
2858 {
2859         TcoreHal *hal = NULL;
2860         TcoreATRequest *req = NULL;
2861         TcorePending *pending = NULL;
2862         char *cmd_str = NULL;
2863         const struct treq_sim_verify_pins *req_data = NULL;
2864         struct s_sim_property *sp = NULL;
2865         TReturn ret = TCORE_RETURN_FAILURE;
2866
2867         dbg("Entry");
2868
2869         if ((o == NULL )|| (ur == NULL))
2870                 return TCORE_RETURN_EINVAL;
2871
2872         hal = tcore_object_get_hal(o);
2873         if (FALSE == tcore_hal_get_power_state(hal)) {
2874                 err("CP NOT READY");
2875                 return TCORE_RETURN_ENOSYS;
2876         }
2877
2878         sp = tcore_sim_ref_userdata(o);
2879         pending = tcore_pending_new(o, 0);
2880         req_data = tcore_user_request_ref_data(ur, NULL);
2881
2882         if (req_data->pin_type == SIM_PTYPE_PIN1) {
2883                 sp->current_sec_op = SEC_PIN1_VERIFY;
2884                 cmd_str = g_strdup_printf("AT+CPIN=\"%s\"", req_data->pin);
2885         } else if (req_data->pin_type == SIM_PTYPE_PIN2) {
2886                 sp->current_sec_op = SEC_PIN2_VERIFY;
2887                 cmd_str = g_strdup_printf("AT+CPIN2=\"%s\"", req_data->pin);
2888         } else if (req_data->pin_type == SIM_PTYPE_SIM) {
2889                 sp->current_sec_op = SEC_SIM_VERIFY;
2890                 cmd_str = g_strdup_printf("AT+CPIN=\"%s\"", req_data->pin);
2891         } else if (req_data->pin_type == SIM_PTYPE_ADM) {
2892                 sp->current_sec_op = SEC_ADM_VERIFY;
2893                 cmd_str = g_strdup_printf("AT+CPIN=\"%s\"", req_data->pin);
2894         } else {
2895                 return TCORE_RETURN_EINVAL;
2896         }
2897
2898         req = tcore_at_request_new(cmd_str, NULL, TCORE_AT_NO_RESULT);
2899         g_free(cmd_str);
2900
2901         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
2902                                 req->cmd, req->prefix, strlen(req->cmd));
2903
2904         tcore_pending_set_request_data(pending, 0, req);
2905         tcore_pending_set_response_callback(pending, on_response_verify_pins, hal);
2906         tcore_pending_link_user_request(pending, ur);
2907         ret = tcore_hal_send_request(hal, pending);
2908
2909         dbg("Exit");
2910         return ret;
2911 }
2912
2913 static TReturn s_verify_puks(CoreObject *o, UserRequest *ur)
2914 {
2915         TcoreHal *hal = NULL;
2916         TcoreATRequest *req = NULL;
2917         TcorePending *pending = NULL;
2918         char *cmd_str = NULL;
2919         const struct treq_sim_verify_puks *req_data;
2920         struct s_sim_property *sp = NULL;
2921         TReturn ret = TCORE_RETURN_FAILURE;
2922
2923         dbg("Entry");
2924
2925         if ((o == NULL )|| (ur == NULL))
2926                 return TCORE_RETURN_EINVAL;
2927
2928         hal = tcore_object_get_hal(o);
2929         if (FALSE == tcore_hal_get_power_state(hal)) {
2930                 err("CP NOT READY");
2931                 return TCORE_RETURN_ENOSYS;
2932         }
2933
2934         sp = tcore_sim_ref_userdata(o);
2935         pending = tcore_pending_new(o, 0);
2936         req_data = tcore_user_request_ref_data(ur, NULL);
2937
2938         if (req_data->puk_type == SIM_PTYPE_PUK1) {
2939                 sp->current_sec_op = SEC_PUK1_VERIFY;
2940                 cmd_str = g_strdup_printf("AT+CPIN=\"%s\", \"%s\"", req_data->puk, req_data->pin);
2941         } else if (req_data->puk_type == SIM_PTYPE_PUK2) {
2942                 sp->current_sec_op = SEC_PUK2_VERIFY;
2943                 cmd_str = g_strdup_printf("AT+CPIN2=\"%s\", \"%s\"", req_data->puk, req_data->pin);
2944         } else {
2945                 return TCORE_RETURN_EINVAL;
2946         }
2947
2948         req = tcore_at_request_new(cmd_str, NULL, TCORE_AT_NO_RESULT);
2949         g_free(cmd_str);
2950
2951         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
2952                                 req->cmd, req->prefix, strlen(req->cmd));
2953
2954         tcore_pending_set_request_data(pending, 0, req);
2955         tcore_pending_set_response_callback(pending, on_response_verify_puks, hal);
2956         tcore_pending_link_user_request(pending, ur);
2957         ret = tcore_hal_send_request(hal, pending);
2958
2959         dbg("Exit");
2960         return ret;
2961 }
2962
2963 static TReturn s_change_pins(CoreObject *o, UserRequest *ur)
2964 {
2965         TcoreHal *hal = NULL;
2966         TcoreATRequest *req = NULL;
2967         TcorePending *pending = NULL;
2968         char *cmd_str = NULL;
2969         const struct treq_sim_change_pins *req_data;
2970         struct s_sim_property *sp = NULL;
2971         char *pin1 = "SC";
2972         char *pin2 = "P2";
2973         TReturn ret = TCORE_RETURN_FAILURE;
2974
2975         dbg("Entry");
2976
2977         if ((o == NULL )|| (ur == NULL))
2978                 return TCORE_RETURN_EINVAL;
2979
2980         hal = tcore_object_get_hal(o);
2981         if (FALSE == tcore_hal_get_power_state(hal)) {
2982                 err("CP NOT READY");
2983                 return TCORE_RETURN_ENOSYS;
2984         }
2985
2986         sp = tcore_sim_ref_userdata(o);
2987         pending = tcore_pending_new(o, 0);
2988         req_data = tcore_user_request_ref_data(ur, NULL);
2989
2990         if (req_data->type == SIM_PTYPE_PIN1) {
2991                 sp->current_sec_op = SEC_PIN1_CHANGE;
2992                 cmd_str = g_strdup_printf("AT+CPWD=\"%s\",\"%s\",\"%s\"", pin1, req_data->old_pin, req_data->new_pin);
2993         } else if (req_data->type == SIM_PTYPE_PIN2) {
2994                 sp->current_sec_op = SEC_PIN2_CHANGE;
2995                 cmd_str = g_strdup_printf("AT+CPWD=\"%s\",\"%s\",\"%s\"", pin2, req_data->old_pin, req_data->new_pin);
2996         } else {
2997                 return TCORE_RETURN_EINVAL;
2998         }
2999         req = tcore_at_request_new(cmd_str, NULL, TCORE_AT_NO_RESULT);
3000         g_free(cmd_str);
3001
3002         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
3003                                 req->cmd, req->prefix, strlen(req->cmd));
3004
3005         tcore_pending_set_request_data(pending, 0, req);
3006         tcore_pending_set_response_callback(pending, on_response_change_pins, hal);
3007         tcore_pending_link_user_request(pending, ur);
3008         ret = tcore_hal_send_request(hal, pending);
3009
3010         dbg("Exit");
3011         return ret;
3012 }
3013
3014 static TReturn s_get_facility_status(CoreObject *o, UserRequest *ur)
3015 {
3016         TcoreHal *hal = NULL;
3017         TcoreATRequest *req = NULL;
3018         TcorePending *pending = NULL;
3019         char *cmd_str = NULL;
3020         const struct treq_sim_get_facility_status *req_data;
3021         struct tresp_sim_get_facility_status *res;
3022         char *fac = "SC";
3023         int mode = 2;    /* 0:unlock, 1:lock, 2:query*/
3024         TReturn ret = TCORE_RETURN_FAILURE;
3025
3026         dbg("Entry");
3027
3028         if ((o == NULL )|| (ur == NULL))
3029                 return TCORE_RETURN_EINVAL;
3030
3031         hal = tcore_object_get_hal(o);
3032         if (FALSE == tcore_hal_get_power_state(hal)) {
3033                 err("CP NOT READY");
3034                 return TCORE_RETURN_ENOSYS;
3035         }
3036
3037         pending = tcore_pending_new(o, 0);
3038         req_data = tcore_user_request_ref_data(ur, NULL);
3039
3040         res = g_try_new0(struct tresp_sim_get_facility_status, 1);
3041         if (!res)
3042                 return TCORE_RETURN_ENOMEM;
3043
3044         res->type = req_data->type;
3045
3046         if (req_data->type == SIM_FACILITY_PS) {
3047                 fac = "PS";               /*PH-SIM, Lock PHone to SIM/UICC card*/
3048         } else if (req_data->type == SIM_FACILITY_SC) {
3049                 fac = "SC";               /*Lock SIM/UICC card, simply PIN1*/
3050         } else if (req_data->type == SIM_FACILITY_FD) {
3051                 fac = "FD";               /*Fixed Dialing Number feature, need PIN2*/
3052         } else if (req_data->type == SIM_FACILITY_PN) {
3053                 fac = "PN";               /*Network Personalization*/
3054         } else if (req_data->type == SIM_FACILITY_PU) {
3055                 fac = "PU";               /*network sUbset Personalization*/
3056         } else if (req_data->type == SIM_FACILITY_PP) {
3057                 fac = "PP";               /*service Provider Personalization*/
3058         } else if (req_data->type == SIM_FACILITY_PC) {
3059                 fac = "PC";               /*Corporate Personalization*/
3060         } else {
3061                 return TCORE_RETURN_EINVAL;
3062         }
3063         cmd_str = g_strdup_printf("AT+CLCK=\"%s\", %d", fac, mode);
3064         req = tcore_at_request_new(cmd_str, "+CLCK:", TCORE_AT_SINGLELINE);
3065         g_free(cmd_str);
3066
3067         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
3068                                 req->cmd, req->prefix, strlen(req->cmd));
3069
3070         tcore_pending_set_request_data(pending, 0, req);
3071         tcore_pending_set_response_callback(pending, on_response_get_facility_status, res);
3072         tcore_pending_link_user_request(pending, ur);
3073         ret = tcore_hal_send_request(hal, pending);
3074
3075         dbg("Exit");
3076         return ret;
3077 }
3078
3079 static TReturn s_enable_facility(CoreObject *o, UserRequest *ur)
3080 {
3081         TcoreHal *hal = NULL;
3082         TcoreATRequest *req = NULL;
3083         TcorePending *pending = NULL;
3084         char *cmd_str = NULL;
3085         const struct treq_sim_enable_facility *req_data;
3086         struct s_sim_property *sp = NULL;
3087         char *fac = "SC";
3088         int mode = 1;    /* 0:unlock, 1:lock, 2:query*/
3089         TReturn ret = TCORE_RETURN_FAILURE;
3090
3091         dbg("Entry");
3092
3093         if ((o == NULL )|| (ur == NULL))
3094                 return TCORE_RETURN_EINVAL;
3095
3096         hal = tcore_object_get_hal(o);
3097         if (FALSE == tcore_hal_get_power_state(hal)) {
3098                 err("CP NOT READY");
3099                 return TCORE_RETURN_ENOSYS;
3100         }
3101
3102         sp = tcore_sim_ref_userdata(o);
3103         pending = tcore_pending_new(o, 0);
3104         req_data = tcore_user_request_ref_data(ur, NULL);
3105
3106         if (req_data->type == SIM_FACILITY_PS) {
3107                 fac = "PS";               /*PH-SIM, Lock PHone to SIM/UICC card*/
3108                 sp->current_sec_op = SEC_SIM_ENABLE;
3109         } else if (req_data->type == SIM_FACILITY_SC) {
3110                 fac = "SC";               /*Lock SIM/UICC card, simply PIN1*/
3111                 sp->current_sec_op = SEC_PIN1_ENABLE;
3112         } else if (req_data->type == SIM_FACILITY_FD) {
3113                 fac = "FD";               /*Fixed Dialing Number feature, need PIN2*/
3114                 sp->current_sec_op = SEC_FDN_ENABLE;
3115         } else if (req_data->type == SIM_FACILITY_PN) {
3116                 fac = "PN";               /*Network Personalization*/
3117                 sp->current_sec_op = SEC_NET_ENABLE;
3118         } else if (req_data->type == SIM_FACILITY_PU) {
3119                 fac = "PU";               /*network sUbset Personalization*/
3120                 sp->current_sec_op = SEC_NS_ENABLE;
3121         } else if (req_data->type == SIM_FACILITY_PP) {
3122                 fac = "PP";               /*service Provider Personalization*/
3123                 sp->current_sec_op = SEC_SP_ENABLE;
3124         } else if (req_data->type == SIM_FACILITY_PC) {
3125                 fac = "PC";               /*Corporate Personalization*/
3126                 sp->current_sec_op = SEC_CP_ENABLE;
3127         } else {
3128                 return TCORE_RETURN_EINVAL;
3129         }
3130         cmd_str = g_strdup_printf("AT+CLCK=\"%s\", %d, \"%s\"", fac, mode, req_data->password);
3131         req = tcore_at_request_new(cmd_str, "+CLCK:", TCORE_AT_SINGLELINE);
3132         g_free(cmd_str);
3133
3134         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
3135                                 req->cmd, req->prefix, strlen(req->cmd));
3136
3137         tcore_pending_set_request_data(pending, 0, req);
3138         tcore_pending_set_response_callback(pending, on_response_enable_facility, hal);
3139         tcore_pending_link_user_request(pending, ur);
3140         ret = tcore_hal_send_request(hal, pending);
3141
3142         dbg("Exit");
3143         return ret;
3144 }
3145
3146 static TReturn s_disable_facility(CoreObject *o, UserRequest *ur)
3147 {
3148         TcoreHal *hal;
3149         TcoreATRequest *req;
3150         TcorePending *pending = NULL;
3151         char *cmd_str = NULL;
3152         const struct treq_sim_enable_facility *req_data;
3153         struct s_sim_property *sp = NULL;
3154         char *fac = "SC";
3155         int mode = 0;    /* 0:unlock, 1:lock, 2:query*/
3156         TReturn ret = TCORE_RETURN_FAILURE;
3157
3158         dbg("Entry");
3159
3160         if ((o == NULL )|| (ur == NULL))
3161                 return TCORE_RETURN_EINVAL;
3162
3163         hal = tcore_object_get_hal(o);
3164         if (FALSE == tcore_hal_get_power_state(hal)) {
3165                 err("CP NOT READY");
3166                 return TCORE_RETURN_ENOSYS;
3167         }
3168
3169         sp = tcore_sim_ref_userdata(o);
3170         pending = tcore_pending_new(o, 0);
3171         req_data = tcore_user_request_ref_data(ur, NULL);
3172
3173         if (req_data->type == SIM_FACILITY_PS) {
3174                 fac = "PS";               /*PH-SIM, Lock PHone to SIM/UICC card*/
3175                 sp->current_sec_op = SEC_SIM_DISABLE;
3176         } else if (req_data->type == SIM_FACILITY_SC) {
3177                 fac = "SC";               /*Lock SIM/UICC card, simply PIN1*/
3178                 sp->current_sec_op = SEC_PIN1_DISABLE;
3179         } else if (req_data->type == SIM_FACILITY_FD) {
3180                 fac = "FD";               /*Fixed Dialing Number feature, need PIN2*/
3181                 sp->current_sec_op = SEC_FDN_DISABLE;
3182         } else if (req_data->type == SIM_FACILITY_PN) {
3183                 fac = "PN";               /*Network Personalization*/
3184                 sp->current_sec_op = SEC_NET_DISABLE;
3185         } else if (req_data->type == SIM_FACILITY_PU) {
3186                 fac = "PU";               /*network sUbset Personalization*/
3187                 sp->current_sec_op = SEC_NS_DISABLE;
3188         } else if (req_data->type == SIM_FACILITY_PP) {
3189                 fac = "PP";               /*service Provider Personalization*/
3190                 sp->current_sec_op = SEC_SP_DISABLE;
3191         } else if (req_data->type == SIM_FACILITY_PC) {
3192                 fac = "PC";               /*Corporate Personalization*/
3193                 sp->current_sec_op = SEC_CP_DISABLE;
3194         } else {
3195                 return TCORE_RETURN_EINVAL;
3196         }
3197         cmd_str = g_strdup_printf("AT+CLCK=\"%s\", %d, \"%s\"", fac, mode, req_data->password);
3198         req = tcore_at_request_new(cmd_str, "+CLCK:", TCORE_AT_SINGLELINE);
3199         g_free(cmd_str);
3200
3201         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
3202                                 req->cmd, req->prefix, strlen(req->cmd));
3203
3204         tcore_pending_set_request_data(pending, 0, req);
3205         tcore_pending_set_response_callback(pending, on_response_disable_facility, hal);
3206         tcore_pending_link_user_request(pending, ur);
3207         ret = tcore_hal_send_request(hal, pending);
3208
3209         dbg("Exit");
3210         return ret;
3211 }
3212
3213 static TReturn s_get_lock_info(CoreObject *o, UserRequest *ur)
3214 {
3215         TcoreHal *hal = NULL;
3216         TcoreATRequest *req = NULL;
3217         TcorePending *pending = NULL;
3218         char *cmd_str = NULL;
3219         int lock_type = 0;
3220         const struct treq_sim_get_lock_info *req_data;
3221         struct s_sim_property *sp = NULL;
3222
3223         dbg("Entry");
3224
3225         hal = tcore_object_get_hal(o);
3226
3227         sp = tcore_sim_ref_userdata(o);
3228         pending = tcore_pending_new(o, 0);
3229         req_data = tcore_user_request_ref_data(ur, NULL);
3230
3231         if ((o == NULL )|| (ur == NULL))
3232                 return TCORE_RETURN_EINVAL;
3233
3234         switch (req_data->type) {
3235         case SIM_FACILITY_PS:
3236                 lock_type = 9; // IMSI lock
3237                 break;
3238
3239         case SIM_FACILITY_SC:
3240                 lock_type = 1;
3241                 break;
3242
3243         case SIM_FACILITY_FD:
3244                 lock_type = 2;
3245                 break;
3246
3247         case SIM_FACILITY_PN:
3248                 lock_type = 5;
3249                 break;
3250
3251         case SIM_FACILITY_PU:
3252                 lock_type = 6;
3253                 break;
3254
3255         case SIM_FACILITY_PP:
3256                 lock_type = 7;
3257                 break;
3258
3259         case SIM_FACILITY_PC:
3260                 lock_type = 8;
3261                 break;
3262
3263         default:
3264                 break;
3265         }
3266         cmd_str = g_strdup_printf("AT+XPINCNT=%d", lock_type);
3267         req = tcore_at_request_new(cmd_str, "+XPINCNT:", TCORE_AT_SINGLELINE);
3268         g_free(cmd_str);
3269
3270         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
3271                                 req->cmd, req->prefix, strlen(req->cmd));
3272
3273         tcore_pending_set_request_data(pending, 0, req);
3274         tcore_pending_set_response_callback(pending, on_response_get_lock_info, hal);
3275         tcore_pending_link_user_request(pending, ur);
3276         tcore_hal_send_request(hal, pending);
3277
3278         dbg("Exit");
3279         return TCORE_RETURN_SUCCESS;
3280 }
3281
3282 static TReturn s_read_file(CoreObject *o, UserRequest *ur)
3283 {
3284         TReturn api_ret = TCORE_RETURN_SUCCESS;
3285         enum tcore_request_command command;
3286
3287         dbg("Entry");
3288
3289         if ((o == NULL )|| (ur == NULL))
3290                 return TCORE_RETURN_EINVAL;
3291
3292         command = tcore_user_request_get_command(ur);
3293         if (FALSE == tcore_hal_get_power_state(tcore_object_get_hal(o))) {
3294                 err("CP NOT READY");
3295                 return TCORE_RETURN_ENOSYS;
3296         }
3297
3298         switch (command) {
3299         case TREQ_SIM_GET_ECC:
3300                 api_ret = _get_file_info(o, ur, SIM_EF_ECC);
3301                 break;
3302
3303         case TREQ_SIM_GET_LANGUAGE:
3304                 if (tcore_sim_get_type(o) == SIM_TYPE_GSM)
3305                         api_ret = _get_file_info(o, ur, SIM_EF_ELP);
3306                 else if (tcore_sim_get_type(o) == SIM_TYPE_USIM)
3307                         api_ret = _get_file_info(o, ur, SIM_EF_LP);
3308                 else
3309                         api_ret = TCORE_RETURN_ENOSYS;
3310                 break;
3311
3312         case TREQ_SIM_GET_ICCID:
3313                 api_ret = _get_file_info(o, ur, SIM_EF_ICCID);
3314                 break;
3315
3316         case TREQ_SIM_GET_MAILBOX:
3317                 if (tcore_sim_get_cphs_status(o))
3318                         api_ret = _get_file_info(o, ur, SIM_EF_CPHS_MAILBOX_NUMBERS);
3319                 else
3320                         api_ret = _get_file_info(o, ur, SIM_EF_MBDN);
3321                 break;
3322
3323         case TREQ_SIM_GET_CALLFORWARDING:
3324                 if (tcore_sim_get_cphs_status(o))
3325                         api_ret = _get_file_info(o, ur, SIM_EF_CPHS_CALL_FORWARD_FLAGS);
3326                 else
3327                         api_ret = _get_file_info(o, ur, SIM_EF_USIM_CFIS);
3328                 break;
3329
3330         case TREQ_SIM_GET_MESSAGEWAITING:
3331                 if (tcore_sim_get_cphs_status(o))
3332                         api_ret = _get_file_info(o, ur, SIM_EF_CPHS_VOICE_MSG_WAITING);
3333                 else
3334                         api_ret = _get_file_info(o, ur, SIM_EF_USIM_MWIS);
3335                 break;
3336
3337         case TREQ_SIM_GET_CPHS_INFO:
3338                 api_ret = _get_file_info(o, ur, SIM_EF_CPHS_CPHS_INFO);
3339                 break;
3340
3341         case TREQ_SIM_GET_MSISDN:
3342                 api_ret = _get_file_info(o, ur, SIM_EF_MSISDN);
3343                 break;
3344
3345         case TREQ_SIM_GET_SPN:
3346                 dbg("enter case SPN");
3347                 api_ret = _get_file_info(o, ur, SIM_EF_SPN);
3348                 break;
3349
3350         case TREQ_SIM_GET_SPDI:
3351                 api_ret = _get_file_info(o, ur, SIM_EF_SPDI);
3352                 break;
3353
3354         case TREQ_SIM_GET_OPL:
3355                 api_ret = _get_file_info(o, ur, SIM_EF_OPL);
3356                 break;
3357
3358         case TREQ_SIM_GET_PNN:
3359                 api_ret = _get_file_info(o, ur, SIM_EF_PNN);
3360                 break;
3361
3362         case TREQ_SIM_GET_CPHS_NETNAME:
3363                 api_ret = _get_file_info(o, ur, SIM_EF_CPHS_OPERATOR_NAME_STRING);
3364                 break;
3365
3366         case TREQ_SIM_GET_OPLMNWACT:
3367                 api_ret = _get_file_info(o, ur, SIM_EF_OPLMN_ACT);
3368                 break;
3369
3370         default:
3371                 dbg("error - not handled read treq command[%d]", command);
3372                 api_ret = TCORE_RETURN_EINVAL;
3373                 break;
3374         }
3375         dbg("Exit");
3376         return api_ret;
3377 }
3378
3379 static TReturn s_update_file(CoreObject *o, UserRequest *ur)
3380 {
3381         TcoreHal *hal;
3382         char *cmd_str = NULL;
3383         TReturn ret = TCORE_RETURN_SUCCESS;
3384         char *encoded_data = NULL;
3385         int encoded_len = 0;
3386         enum tcore_request_command command;
3387         enum tel_sim_file_id ef = SIM_EF_INVALID;
3388         const struct treq_sim_set_callforwarding *cf;
3389         const struct treq_sim_set_language *cl;
3390         struct s_sim_property file_meta = {0, };
3391         int p1 = 0;
3392         int p2 = 0;
3393         int p3 = 0;
3394         int cmd = 0;
3395         int out_length = 0;
3396         int trt = 0;
3397         struct tel_sim_language sim_language;
3398         char *tmp = NULL;
3399         gboolean result;
3400
3401         command = tcore_user_request_get_command(ur);
3402
3403         dbg("Entry");
3404
3405         if ((o == NULL )|| (ur == NULL)) {
3406                 return TCORE_RETURN_EINVAL;
3407         }
3408
3409         hal = tcore_object_get_hal(o);
3410         if (FALSE == tcore_hal_get_power_state(hal)) {
3411                 err("CP NOT READY");
3412                 return TCORE_RETURN_ENOSYS;
3413         }
3414
3415         switch (command) {
3416         case TREQ_SIM_SET_LANGUAGE:
3417                 cl = tcore_user_request_ref_data(ur, NULL);
3418                 memset(&sim_language, 0x00, sizeof(struct tel_sim_language));
3419                 cmd = 214;
3420
3421                 sim_language.language_count = 1;
3422                 sim_language.language[0] = cl->language;
3423                 dbg("language %d", cl->language);
3424
3425                 if (tcore_sim_get_type(o) == SIM_TYPE_GSM) {
3426                         dbg("2G");
3427                         ef = SIM_EF_LP;
3428                         tmp = tcore_sim_encode_lp(&out_length, &sim_language);
3429
3430                         encoded_data = (char *)malloc(2 * (sim_language.language_count) + 1);
3431                         memset(encoded_data, 0x00, (2 * sim_language.language_count) + 1);
3432                         result = util_byte_to_hex(tmp, encoded_data, out_length);
3433
3434                         p1 = 0;
3435                         p2 = 0;
3436                         p3 = out_length;
3437                         dbg("encoded_data - %s ---", encoded_data);
3438                         dbg("out_length - %d ---", out_length);
3439                 } else if (tcore_sim_get_type(o) == SIM_TYPE_USIM) {
3440                         dbg("3G");
3441                         ef = SIM_EF_LP;
3442                         tmp = tcore_sim_encode_li(&out_length, &sim_language);
3443
3444                         encoded_data = (char *)malloc(2 * (out_length) + 1);
3445                         memset(encoded_data, 0x00, (2 * out_length) + 1);
3446                         result = util_byte_to_hex(tmp, encoded_data, out_length);
3447
3448                         p1 = 0;
3449                         p2 = 0;
3450                         p3 = out_length;
3451                         dbg("encoded_data - %s ---", encoded_data);
3452                         dbg("out_length - %d ---", out_length);
3453                 } else {
3454                         ret = TCORE_RETURN_ENOSYS;
3455                 }
3456                 break;
3457
3458         case TREQ_SIM_SET_CALLFORWARDING:
3459                 cf = tcore_user_request_ref_data(ur, NULL);
3460                 if (tcore_sim_get_cphs_status(o)) {
3461                         tmp = tcore_sim_encode_cff((const struct tel_sim_cphs_cf*)&cf->cphs_cf);
3462                         ef = SIM_EF_CPHS_CALL_FORWARD_FLAGS;
3463                         p1 = 0;
3464                         p2 = 0;
3465                         p3 = strlen(tmp);
3466                         encoded_data = (char *)g_try_malloc0(2 * (p3) + 1);
3467                         result = util_byte_to_hex(tmp, encoded_data, p3);
3468                         cmd = 214;         /*command - 214 : UPDATE BINARY*/
3469                 } else {
3470                         tmp = tcore_sim_encode_cfis(&encoded_len, (const struct tel_sim_cfis*)&cf->cf);
3471                         ef = SIM_EF_USIM_CFIS;
3472                         p1 = 1;
3473                         p2 = 0x04;
3474                         p3 = encoded_len;
3475                         encoded_data = (char *)g_try_malloc0(2 * (encoded_len) + 1);
3476                         result = util_byte_to_hex(tmp, encoded_data, encoded_len);
3477                         cmd = 220;         /*command - 220 : UPDATE RECORD*/
3478                 }
3479                 break;
3480
3481         default:
3482                 dbg("error - not handled update treq command[%d]", command);
3483                 ret = TCORE_RETURN_EINVAL;
3484                 break;
3485         }
3486
3487         file_meta.file_id = ef;
3488         dbg("File ID: [0x%x]", file_meta.file_id);
3489
3490         trt = tcore_user_request_set_metainfo(ur,
3491                                                 sizeof(struct s_sim_property), &file_meta);
3492         dbg("trt[%d]", trt);
3493
3494         cmd_str = g_strdup_printf("AT+CRSM=%d,%d,%d,%d,%d,\"%s\"", cmd, ef, p1, p2, p3, encoded_data);
3495
3496         ret = tcore_prepare_and_send_at_request(o, cmd_str, "+CRSM:",
3497                                                                 TCORE_AT_SINGLELINE, ur,
3498                                                                 on_response_update_file, hal,
3499                                                                 NULL, NULL);
3500
3501         g_free(cmd_str);
3502         g_free(encoded_data);
3503         if (tmp) {
3504                 free(tmp);
3505         }
3506
3507         dbg("Exit");
3508         return ret;
3509 }
3510
3511 static TReturn s_transmit_apdu(CoreObject *o, UserRequest *ur)
3512 {
3513         const struct treq_sim_transmit_apdu *req_data;
3514         TcoreHal *hal = NULL;
3515         char *cmd_str = NULL;
3516         char *apdu = NULL;
3517         int result = 0;
3518         TReturn ret = TCORE_RETURN_FAILURE;
3519
3520         dbg("Entry");
3521
3522         if ((o == NULL )|| (ur == NULL))
3523                 return TCORE_RETURN_EINVAL;
3524
3525         hal = tcore_object_get_hal(o);
3526         if (FALSE == tcore_hal_get_power_state(hal)) {
3527                 err("CP NOT READY");
3528                 return TCORE_RETURN_ENOSYS;
3529         }
3530
3531         req_data = tcore_user_request_ref_data(ur, NULL);
3532
3533         apdu = (char *)g_try_malloc0((2 * req_data->apdu_length) + 1);
3534         result = util_byte_to_hex((const char *)req_data->apdu, apdu, req_data->apdu_length);
3535         cmd_str = g_strdup_printf("AT+CSIM=%d,\"%s\"", strlen(apdu), apdu);
3536
3537         ret = tcore_prepare_and_send_at_request(o, cmd_str, "+CSIM:",
3538                                                                 TCORE_AT_SINGLELINE, ur,
3539                                                                 on_response_transmit_apdu, hal,
3540                                                                 NULL, NULL);
3541         g_free(cmd_str);
3542         g_free(apdu);
3543
3544         dbg("Exit");
3545         return ret;
3546 }
3547
3548 static TReturn s_get_atr(CoreObject *o, UserRequest *ur)
3549 {
3550         TcoreHal *hal = NULL;
3551
3552         dbg("Entry");
3553
3554         if ((o == NULL )|| (ur == NULL)) {
3555                 err("Invalid parameters");
3556                 return TCORE_RETURN_EINVAL;
3557         }
3558
3559         hal = tcore_object_get_hal(o);
3560         if (FALSE == tcore_hal_get_power_state(hal)) {
3561                 err("CP NOT READY");
3562                 return TCORE_RETURN_ENOSYS;
3563         }
3564
3565         return tcore_prepare_and_send_at_request(o, "AT+XGATR", "+XGATR:",
3566                                                                 TCORE_AT_SINGLELINE, ur,
3567                                                                 on_response_get_atr, hal,
3568                                                                 NULL, NULL);
3569 }
3570
3571 /* SIM Operations */
3572 static struct tcore_sim_operations sim_ops = {
3573         .verify_pins = s_verify_pins,
3574         .verify_puks = s_verify_puks,
3575         .change_pins = s_change_pins,
3576         .get_facility_status = s_get_facility_status,
3577         .enable_facility = s_enable_facility,
3578         .disable_facility = s_disable_facility,
3579         .get_lock_info = s_get_lock_info,
3580         .read_file = s_read_file,
3581         .update_file = s_update_file,
3582         .transmit_apdu = s_transmit_apdu,
3583         .get_atr = s_get_atr,
3584         .req_authentication = NULL,
3585 };
3586
3587 gboolean s_sim_init(TcorePlugin *cp, CoreObject *co_sim)
3588 {
3589         struct s_sim_property *file_meta;
3590
3591         dbg("Entry");
3592
3593         tcore_sim_override_ops(co_sim, &sim_ops);
3594
3595         file_meta = g_try_new0(struct s_sim_property, 1);
3596         if (file_meta == NULL)
3597                 return FALSE;
3598
3599         tcore_sim_link_userdata(co_sim, file_meta);
3600
3601         tcore_object_override_callback(co_sim, "+XLOCK:",
3602                                                         on_event_facility_lock_status, NULL);
3603         tcore_object_override_callback(co_sim, "+XSIM:",
3604                                                         on_event_pin_status, NULL);
3605
3606         tcore_server_add_notification_hook(tcore_plugin_ref_server(cp),
3607                                                         TNOTI_MODEM_POWER, on_hook_modem_power, co_sim);
3608
3609         dbg("Exit");
3610
3611         return TRUE;
3612 }
3613
3614 void s_sim_exit(TcorePlugin *cp, CoreObject *co_sim)
3615 {
3616         struct s_sim_property *file_meta;
3617
3618         file_meta = tcore_sim_ref_userdata(co_sim);
3619         g_free(file_meta);
3620
3621         dbg("Exit");
3622 }