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
2091         case 1:
2092                 sim_status = SIM_STATUS_PIN_REQUIRED;
2093                 dbg("PIN REQUIRED");
2094                 break;
2095
2096         case 2:
2097                 sim_status = SIM_STATUS_INITIALIZING;
2098                 dbg("PIN DISABLED AT BOOT UP");
2099                 break;
2100
2101         case 3:
2102                 sim_status = SIM_STATUS_INITIALIZING;
2103                 dbg("PIN VERIFIED");
2104                 break;
2105
2106         case 4:
2107                 sim_status = SIM_STATUS_PUK_REQUIRED;
2108                 dbg("PUK REQUIRED");
2109                 break;
2110
2111         case 5:
2112                 sim_status = SIM_STATUS_CARD_BLOCKED;
2113                 dbg("CARD PERMANENTLY BLOCKED");
2114                 break;
2115
2116         case 6:
2117                 sim_status = SIM_STATUS_CARD_ERROR;
2118                 dbg("SIM CARD ERROR");
2119                 break;
2120
2121         case 7:
2122                 sim_status = SIM_STATUS_INIT_COMPLETED;
2123                 dbg("SIM INIT COMPLETED");
2124                 break;
2125
2126         case 8:
2127                 sim_status = SIM_STATUS_CARD_ERROR;
2128                 dbg("SIM CARD ERROR");
2129                 break;
2130
2131         case 9:
2132                 sim_status = SIM_STATUS_CARD_REMOVED;
2133                 dbg("SIM REMOVED");
2134                 break;
2135
2136         case 12:
2137                 dbg("SIM SMS Ready");
2138                 notify_sms_state(plugin, o, TRUE);
2139                 goto out;
2140
2141         case 99:
2142                 sim_status = SIM_STATUS_UNKNOWN;
2143                 dbg("SIM STATE UNKNOWN");
2144                 break;
2145
2146         default:
2147                 err("Unknown/Unsupported SIM state: [%d]", sim_state);
2148                 goto out;
2149         }
2150
2151         switch (sim_status) {
2152         case SIM_STATUS_INIT_COMPLETED:
2153                 dbg("[SIM] SIM INIT COMPLETED");
2154                 if (tcore_sim_get_type(o) == SIM_TYPE_UNKNOWN) {
2155                         _get_sim_type(o);
2156                         goto out;
2157                 }
2158
2159                 break;
2160
2161         case SIM_STATUS_CARD_REMOVED:
2162                 dbg("[SIM] SIM CARD REMOVED");
2163                 tcore_sim_set_type(o, SIM_TYPE_UNKNOWN);
2164                 break;
2165
2166         case SIM_STATUS_CARD_NOT_PRESENT:
2167                 dbg("[SIM] SIM CARD NOT PRESENT");
2168                 tcore_sim_set_type(o, SIM_TYPE_UNKNOWN);
2169                 break;
2170
2171         case SIM_STATUS_CARD_ERROR:
2172                 dbg("[SIM] SIM CARD ERROR");
2173                 tcore_sim_set_type(o, SIM_TYPE_UNKNOWN);
2174                 break;
2175
2176         default:
2177                 dbg("SIM Status: [0x%02x]", sim_status);
2178                 break;
2179         }
2180
2181         _sim_status_update(o, sim_status);
2182
2183 out:
2184         tcore_at_tok_free(tokens);
2185
2186         dbg("Exit");
2187         return TRUE;
2188 }
2189
2190 static void on_response_get_sim_status(TcorePending *p, int data_len, const void *data, void *user_data)
2191 {
2192         const TcoreATResponse *resp = data;
2193         CoreObject *co_sim = NULL;
2194
2195         dbg("Entry");
2196
2197         co_sim = tcore_pending_ref_core_object(p);
2198
2199         if (resp->success > 0) {
2200                 dbg("RESPONSE OK");
2201                 if (resp->lines)
2202                         on_event_pin_status(co_sim, resp->lines, NULL);
2203         } else {
2204                 dbg("RESPONSE NOK");
2205         }
2206
2207         dbg("Exit");
2208 }
2209
2210 static enum tcore_hook_return on_hook_modem_power(Server *s, CoreObject *source, enum tcore_notification_command command,
2211                                                                                           unsigned int data_len, void *data, void *user_data)
2212 {
2213         TcorePlugin *plugin = tcore_object_ref_plugin(source);
2214         CoreObject *co_sim = tcore_plugin_ref_core_object(plugin, CORE_OBJECT_TYPE_SIM);
2215
2216         if (co_sim == NULL)
2217                 return TCORE_HOOK_RETURN_CONTINUE;
2218
2219         dbg("Get SIM status");
2220
2221         sim_prepare_and_send_pending_request(co_sim, "AT+XSIMSTATE?", "+XSIMSTATE:", TCORE_AT_SINGLELINE, on_response_get_sim_status);
2222
2223         return TCORE_HOOK_RETURN_CONTINUE;
2224 }
2225
2226 static void on_response_verify_pins(TcorePending *p, int data_len, const void *data, void *user_data)
2227 {
2228         const TcoreATResponse *resp = data;
2229         UserRequest *ur = NULL;
2230         CoreObject *co_sim = NULL;
2231         struct s_sim_property *sp = NULL;
2232         GSList *tokens = NULL;
2233         struct tresp_sim_verify_pins res;
2234         GQueue *queue = NULL;
2235         const char *line;
2236         int err;
2237
2238         dbg("Entry");
2239
2240         co_sim = tcore_pending_ref_core_object(p);
2241         sp = tcore_sim_ref_userdata(co_sim);
2242         ur = tcore_pending_ref_user_request(p);
2243
2244         memset(&res, 0, sizeof(struct tresp_sim_verify_pins));
2245
2246         if (resp->success > 0) {
2247                 dbg("RESPONSE OK");
2248                 res.result = SIM_PIN_OPERATION_SUCCESS;
2249
2250                 /* Get PIN facility */
2251                 res.pin_type = _sim_get_current_pin_facility(sp->current_sec_op);
2252                 if ((res.pin_type == SIM_PTYPE_PIN1)
2253                                 || (res.pin_type == SIM_PTYPE_SIM)) {
2254                         if (tcore_sim_get_status(co_sim) != SIM_STATUS_INIT_COMPLETED) {
2255                                 /* Update SIM Status */
2256                                 _sim_status_update(co_sim, SIM_STATUS_INITIALIZING);
2257                         }
2258                 }
2259
2260                 /* Send Response */
2261                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2262                                         sizeof(struct tresp_sim_verify_pins), &res);
2263         } else {
2264                 dbg("RESPONSE NOK");
2265                 line = (const char *)resp->final_response;
2266                 tokens = tcore_at_tok_new(line);
2267                 if (g_slist_length(tokens) < 1) {
2268                         dbg("Unkown Error OR String corrupted");
2269                         res.result = TCORE_RETURN_3GPP_ERROR;
2270
2271                         /* Send Response */
2272                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2273                                                                 sizeof(struct tresp_sim_verify_pins), &res);
2274                 } else {
2275                         err = atoi(g_slist_nth_data(tokens, 0));
2276                         dbg("Error: [%d]", err);
2277
2278                         queue = tcore_object_ref_user_data(co_sim);
2279                         ur = tcore_user_request_ref(ur);
2280
2281                         /* Get retry count */
2282                         _get_retry_count(co_sim, ur);
2283                 }
2284
2285                 /* Free tokens */
2286                 tcore_at_tok_free(tokens);
2287         }
2288
2289         dbg("Exit");
2290 }
2291
2292 static void on_response_verify_puks(TcorePending *p, int data_len, const void *data, void *user_data)
2293 {
2294         const TcoreATResponse *resp = data;
2295         UserRequest *ur = NULL;
2296         CoreObject *co_sim = NULL;
2297         struct s_sim_property *sp = NULL;
2298         GSList *tokens = NULL;
2299         struct tresp_sim_verify_puks res;
2300         GQueue *queue = NULL;
2301         const char *line;
2302         int err;
2303
2304         dbg("Entry");
2305
2306         co_sim = tcore_pending_ref_core_object(p);
2307         sp = tcore_sim_ref_userdata(co_sim);
2308         ur = tcore_pending_ref_user_request(p);
2309
2310         memset(&res, 0, sizeof(struct tresp_sim_verify_pins));
2311
2312         if (resp->success > 0) {
2313                 dbg("RESPONSE OK");
2314                 res.result = SIM_PIN_OPERATION_SUCCESS;
2315                 res.pin_type = _sim_get_current_pin_facility(sp->current_sec_op);
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                 dbg("RESPONSE NOK");
2322                 line = (const char *)resp->final_response;
2323                 tokens = tcore_at_tok_new(line);
2324
2325                 if (g_slist_length(tokens) < 1) {
2326                         dbg("Unkown Error OR String corrupted");
2327                         res.result = TCORE_RETURN_3GPP_ERROR;
2328
2329                         /* Send Response */
2330                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2331                                                         sizeof(struct tresp_sim_verify_pins), &res);
2332                 } else {
2333                         err = atoi(g_slist_nth_data(tokens, 0));
2334                         queue = tcore_object_ref_user_data(co_sim);
2335                         ur = tcore_user_request_ref(ur);
2336                         _get_retry_count(co_sim, ur);
2337                 }
2338                 tcore_at_tok_free(tokens);
2339         }
2340         dbg("Exit");
2341 }
2342
2343 static void on_response_change_pins(TcorePending *p, int data_len, const void *data, void *user_data)
2344 {
2345         const TcoreATResponse *resp = data;
2346         UserRequest *ur = NULL;
2347         CoreObject *co_sim = NULL;
2348         struct s_sim_property *sp = NULL;
2349         GSList *tokens = NULL;
2350         struct tresp_sim_change_pins res;
2351         GQueue *queue;
2352         const char *line;
2353         int err;
2354
2355         dbg("Entry");
2356
2357         co_sim = tcore_pending_ref_core_object(p);
2358         sp = tcore_sim_ref_userdata(co_sim);
2359         ur = tcore_pending_ref_user_request(p);
2360
2361         memset(&res, 0, sizeof(struct tresp_sim_change_pins));
2362
2363         if (resp->success > 0) {
2364                 dbg("RESPONSE OK");
2365                 res.result = SIM_PIN_OPERATION_SUCCESS;
2366                 res.pin_type = _sim_get_current_pin_facility(sp->current_sec_op);
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                 dbg("RESPONSE NOK");
2373                 line = (const char *)resp->final_response;
2374                 tokens = tcore_at_tok_new(line);
2375
2376                 if (g_slist_length(tokens) < 1) {
2377                         dbg("Unkown Error OR String corrupted");
2378                         res.result = TCORE_RETURN_3GPP_ERROR;
2379
2380                         /* Send Response */
2381                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2382                                                         sizeof(struct tresp_sim_change_pins), &res);
2383                 } else {
2384                         err = atoi(g_slist_nth_data(tokens, 0));
2385                         queue = tcore_object_ref_user_data(co_sim);
2386                         ur = tcore_user_request_ref(ur);
2387                         _get_retry_count(co_sim, ur);
2388                 }
2389
2390                 /* Free tokens */
2391                 tcore_at_tok_free(tokens);
2392         }
2393         dbg("Exit");
2394 }
2395
2396 static void on_response_get_facility_status(TcorePending *p, int data_len, const void *data, void *user_data)
2397 {
2398         const TcoreATResponse *resp = data;
2399         UserRequest *ur = NULL;
2400         GSList *tokens = NULL;
2401         struct tresp_sim_get_facility_status *res = user_data;
2402         const char *line;
2403
2404         dbg("Entry");
2405
2406         ur = tcore_pending_ref_user_request(p);
2407
2408         res->result = SIM_PIN_OPERATION_SUCCESS;
2409
2410         if (resp->success > 0) {
2411                 dbg("RESPONSE OK");
2412                 if (resp->lines) {
2413                         line = (const char *)resp->lines->data;
2414                         tokens = tcore_at_tok_new(line);
2415                         if (g_slist_length(tokens) != 1) {
2416                                 msg("Invalid message");
2417                                 tcore_at_tok_free(tokens);
2418                                 return;
2419                         }
2420                 }
2421                 res->b_enable = atoi(g_slist_nth_data(tokens, 0));
2422         } else {
2423                 dbg("RESPONSE NOK");
2424                 res->result = SIM_INCOMPATIBLE_PIN_OPERATION;
2425         }
2426
2427         /* Send Response */
2428         if (ur) {
2429                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2430                                                 sizeof(struct tresp_sim_get_facility_status), res);
2431         }
2432         tcore_at_tok_free(tokens);
2433         g_free(res);
2434         dbg("Exit");
2435 }
2436
2437 static void on_response_enable_facility(TcorePending *p, int data_len, const void *data, void *user_data)
2438 {
2439         const TcoreATResponse *resp = data;
2440         UserRequest *ur = NULL;
2441         CoreObject *co_sim = NULL;
2442         struct s_sim_property *sp = NULL;
2443         GSList *tokens = NULL;
2444         struct tresp_sim_enable_facility res;
2445         GQueue *queue;
2446         const char *line;
2447
2448         dbg("Entry");
2449
2450         co_sim = tcore_pending_ref_core_object(p);
2451         sp = tcore_sim_ref_userdata(co_sim);
2452         ur = tcore_pending_ref_user_request(p);
2453
2454         memset(&res, 0, sizeof(struct tresp_sim_enable_facility));
2455
2456         res.result = SIM_CARD_ERROR;
2457         res.type = _sim_get_current_pin_facility(sp->current_sec_op);
2458
2459         if (resp->success > 0) {
2460                 dbg("RESPONSE OK");
2461                 if (resp->lines) {
2462                         line = (const char *)resp->lines->data;
2463                         tokens = tcore_at_tok_new(line);
2464                         if (g_slist_length(tokens) != 1) {
2465                                 msg("Invalid message");
2466
2467                                 /* Send Response */
2468                                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2469                                                                          sizeof(struct tresp_sim_enable_facility), &res);
2470                                 tcore_at_tok_free(tokens);
2471                                 return;
2472                         }
2473                 }
2474
2475                 res.result = SIM_PIN_OPERATION_SUCCESS;
2476
2477                 /* Send Response */
2478                 if (ur) {
2479                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2480                                                                  sizeof(struct tresp_sim_enable_facility), &res);
2481                 }
2482
2483                 /* Free tokens */
2484                 tcore_at_tok_free(tokens);
2485         } else {
2486                 dbg("RESPONSE NOK");
2487                 queue = tcore_object_ref_user_data(co_sim);
2488                 ur = tcore_user_request_ref(ur);
2489                 _get_retry_count(co_sim, ur);
2490         }
2491         dbg("Exit");
2492 }
2493
2494 static void on_response_disable_facility(TcorePending *p, int data_len, const void *data, void *user_data)
2495 {
2496         const TcoreATResponse *resp = data;
2497         UserRequest *ur = NULL;
2498         CoreObject *co_sim = NULL;
2499         struct s_sim_property *sp = NULL;
2500         GSList *tokens = NULL;
2501         struct tresp_sim_disable_facility res;
2502         GQueue *queue;
2503         const char *line;
2504
2505         dbg("Entry");
2506
2507         co_sim = tcore_pending_ref_core_object(p);
2508         sp = tcore_sim_ref_userdata(co_sim);
2509         ur = tcore_pending_ref_user_request(p);
2510
2511         memset(&res, 0, sizeof(struct tresp_sim_disable_facility));
2512
2513         res.result = SIM_CARD_ERROR;
2514         res.type = _sim_get_current_pin_facility(sp->current_sec_op);
2515
2516         if (resp->success > 0) {
2517                 dbg("RESPONSE OK");
2518                 if (resp->lines) {
2519                         line = (const char *)resp->lines->data;
2520                         tokens = tcore_at_tok_new(line);
2521                         if (g_slist_length(tokens) != 1) {
2522                                 msg("Invalid message");
2523
2524                                 /* Send Response */
2525                                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2526                                                                                 sizeof(struct tresp_sim_disable_facility), &res);
2527                                 tcore_at_tok_free(tokens);
2528                                 return;
2529                         }
2530                 }
2531
2532                 res.result = SIM_PIN_OPERATION_SUCCESS;
2533                 /* Send Response */
2534                 if (ur) {
2535                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2536                                                                         sizeof(struct tresp_sim_disable_facility), &res);
2537                 }
2538
2539                 /* Free tokens */
2540                 tcore_at_tok_free(tokens);
2541         } else {
2542                 dbg("RESPONSE NOK");
2543                 queue = tcore_object_ref_user_data(co_sim);
2544                 ur = tcore_user_request_ref(ur);
2545                 _get_retry_count(co_sim, ur);
2546         }
2547         dbg("Exit");
2548 }
2549
2550 static void on_response_get_lock_info(TcorePending *p, int data_len, const void *data, void *user_data)
2551 {
2552         const TcoreATResponse *resp = data;
2553         UserRequest *ur = NULL;
2554         CoreObject *co_sim = NULL;
2555         struct s_sim_property *sp = NULL;
2556         GSList *tokens = NULL;
2557         const char *line;
2558         int lock_type;
2559         int attempts_left = 0;
2560         int time_penalty = 0;
2561
2562         dbg("Entry");
2563
2564         co_sim = tcore_pending_ref_core_object(p);
2565         sp = tcore_sim_ref_userdata(co_sim);
2566         ur = tcore_pending_ref_user_request(p);
2567
2568         if (resp->success > 0) {
2569                 dbg("RESPONSE OK");
2570                 if (resp->lines) {
2571                         line = (const char *)resp->lines->data;
2572                         dbg("Line: [%s]", line);
2573                         tokens = tcore_at_tok_new(line);
2574                         if (g_slist_length(tokens) != 3) {
2575                                 msg("Invalid message");
2576                                 tcore_at_tok_free(tokens);
2577                                 return;
2578                         }
2579                 }
2580
2581                 lock_type = atoi(g_slist_nth_data(tokens, 0));
2582                 attempts_left = atoi(g_slist_nth_data(tokens, 1));
2583                 time_penalty = atoi(g_slist_nth_data(tokens, 2));
2584
2585                 switch (sp->current_sec_op) {
2586                 case SEC_PIN1_VERIFY:
2587                 case SEC_PIN2_VERIFY:
2588                 case SEC_SIM_VERIFY:
2589                 case SEC_ADM_VERIFY:
2590                 {
2591                         struct tresp_sim_verify_pins v_pin = {0, };
2592
2593                         v_pin.result = SIM_INCORRECT_PASSWORD;
2594                         v_pin.pin_type = _sim_get_current_pin_facility(sp->current_sec_op);
2595                         v_pin.retry_count = attempts_left;
2596                         dbg("PIN Type: [0x%02x] Attempts left: [%d]",
2597                                                         v_pin.pin_type, v_pin.retry_count);
2598
2599                         /* Send Response */
2600                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2601                                                                                         sizeof(v_pin), &v_pin);
2602                 }
2603                 break;
2604
2605                 case SEC_PUK1_VERIFY:
2606                 case SEC_PUK2_VERIFY:
2607                 {
2608                         struct tresp_sim_verify_puks v_puk = {0, };
2609
2610                         v_puk.result = SIM_INCORRECT_PASSWORD;
2611                         v_puk.pin_type = _sim_get_current_pin_facility(sp->current_sec_op);
2612                         v_puk.retry_count = attempts_left;
2613                         dbg("PUK Type: [0x%02x] Attempts left: [%d]",
2614                                                         v_puk.pin_type, v_puk.retry_count);
2615
2616                         /* Send Response */
2617                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2618                                                                                         sizeof(v_puk), &v_puk);
2619                 }
2620                 break;
2621
2622                 case SEC_PIN1_CHANGE:
2623                 case SEC_PIN2_CHANGE:
2624                 {
2625                         struct tresp_sim_change_pins change_pin = {0, };
2626
2627                         change_pin.result = SIM_INCORRECT_PASSWORD;
2628                         change_pin.pin_type = _sim_get_current_pin_facility(sp->current_sec_op);
2629                         change_pin.retry_count = attempts_left;
2630                         dbg("PIN Type: [0x%02x] Attempts left: [%d]",
2631                                                         change_pin.pin_type, change_pin.retry_count);
2632
2633                         /* Send Response */
2634                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2635                                                                                         sizeof(change_pin), &change_pin);
2636                 }
2637                 break;
2638
2639                 case SEC_PIN1_DISABLE:
2640                 case SEC_PIN2_DISABLE:
2641                 case SEC_FDN_DISABLE:
2642                 case SEC_SIM_DISABLE:
2643                 case SEC_NET_DISABLE:
2644                 case SEC_NS_DISABLE:
2645                 case SEC_SP_DISABLE:
2646                 case SEC_CP_DISABLE:
2647                 {
2648                         struct tresp_sim_disable_facility dis_facility = {0, };
2649
2650                         dis_facility.result = SIM_INCORRECT_PASSWORD;
2651                         dis_facility.type = _sim_get_current_pin_facility(sp->current_sec_op);
2652                         dis_facility.retry_count = attempts_left;
2653                         dbg("Facility Type: [0x%02x] Attempts left: [%d]",
2654                                                         dis_facility.type, dis_facility.retry_count);
2655
2656                         /* Send Response */
2657                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2658                                                                                         sizeof(dis_facility), &dis_facility);
2659                 }
2660                 break;
2661
2662                 case SEC_PIN1_ENABLE:
2663                 case SEC_PIN2_ENABLE:
2664                 case SEC_FDN_ENABLE:
2665                 case SEC_SIM_ENABLE:
2666                 case SEC_NET_ENABLE:
2667                 case SEC_NS_ENABLE:
2668                 case SEC_SP_ENABLE:
2669                 case SEC_CP_ENABLE:
2670                 {
2671                         struct tresp_sim_enable_facility en_facility = {0, };
2672
2673                         en_facility.result = SIM_INCORRECT_PASSWORD;
2674                         en_facility.type = _sim_get_current_pin_facility(sp->current_sec_op);
2675                         en_facility.retry_count = attempts_left;
2676                         dbg("Facility Type: [0x%02x] Attempts left: [%d]",
2677                                                         en_facility.type, en_facility.retry_count);
2678
2679                         /* Send Response */
2680                         tcore_user_request_send_response(ur, _find_resp_command(ur),
2681                                                                                         sizeof(en_facility), &en_facility);
2682                 }
2683                 break;
2684
2685                 default:
2686                         dbg("not handled sec op[%d]", sp->current_sec_op);
2687                         break;
2688                 }
2689
2690                 /* Free tokens */
2691                 tcore_at_tok_free(tokens);
2692         }
2693         dbg("Exit");
2694 }
2695
2696 static void on_response_update_file(TcorePending *p, int data_len, const void *data, void *user_data)
2697 {
2698         const TcoreATResponse *resp = data;
2699         UserRequest *ur = NULL;
2700         CoreObject *co_sim = NULL;
2701         struct tresp_sim_set_data resp_cf = {0, };
2702         struct tresp_sim_set_data resp_language = {0, };
2703         struct s_sim_property *sp = NULL;
2704         GSList *tokens = NULL;
2705         enum tel_sim_access_result result = SIM_CARD_ERROR;
2706         const char *line;
2707         int sw1 = 0;
2708         int sw2 = 0;
2709
2710         dbg("Entry");
2711
2712         co_sim = tcore_pending_ref_core_object(p);
2713         ur = tcore_pending_ref_user_request(p);
2714         sp = (struct s_sim_property *)tcore_user_request_ref_metainfo(ur, NULL);
2715
2716         if (resp->success > 0) {
2717                 dbg("RESPONSE OK");
2718                 if (resp->lines) {
2719                         line = (const char *)resp->lines->data;
2720                         tokens = tcore_at_tok_new(line);
2721                         if (g_slist_length(tokens) != 2) {
2722                                 msg("Invalid message");
2723                                 goto OUT;
2724                         }
2725                 }
2726                 sw1 = atoi(g_slist_nth_data(tokens, 0));
2727                 sw2 = atoi(g_slist_nth_data(tokens, 1));
2728
2729                 if ((sw1 == 0x90 && sw2 == 0x00) || sw1 == 0x91) {
2730                         result = SIM_ACCESS_SUCCESS;
2731                 } else {
2732                         result = _decode_status_word(sw1, sw2);
2733                 }
2734         } else {
2735                 dbg("RESPONSE NOK");
2736                 result = SIM_ACCESS_FAILED;
2737         }
2738 OUT:
2739         switch (sp->file_id) {
2740         case SIM_EF_CPHS_CALL_FORWARD_FLAGS:
2741         case SIM_EF_USIM_CFIS:
2742                 resp_cf.result = result;
2743
2744                 /* Send Response */
2745                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2746                                                         sizeof(struct tresp_sim_set_data), &resp_cf);
2747                 break;
2748
2749         case SIM_EF_ELP:
2750         case SIM_EF_LP:
2751         case SIM_EF_USIM_LI:
2752         case SIM_EF_USIM_PL:
2753                 resp_language.result = result;
2754
2755                 /* Send Response */
2756                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2757                                                         sizeof(struct tresp_sim_set_data), &resp_language);
2758                 break;
2759
2760         default:
2761                 dbg("Invalid File ID - %d", sp->file_id);
2762                 break;
2763         }
2764         tcore_at_tok_free(tokens);
2765         dbg("Exit");
2766 }
2767
2768 static void on_response_transmit_apdu(TcorePending *p, int data_len, const void *data, void *user_data)
2769 {
2770         const TcoreATResponse *resp = data;
2771         UserRequest *ur = NULL;
2772         CoreObject *co_sim = NULL;
2773         GSList *tokens = NULL;
2774         struct tresp_sim_transmit_apdu res;
2775         const char *line;
2776
2777         dbg("Entry");
2778
2779         co_sim = tcore_pending_ref_core_object(p);
2780         ur = tcore_pending_ref_user_request(p);
2781
2782         memset(&res, 0, sizeof(struct tresp_sim_transmit_apdu));
2783         res.result = SIM_ACCESS_FAILED;
2784
2785         if (resp->success > 0) {
2786                 dbg("RESPONSE OK");
2787                 if (resp->lines) {
2788                         char *tmp = NULL;
2789                         char *decoded_data = NULL;
2790                         line = (const char *)resp->lines->data;
2791                         tokens = tcore_at_tok_new(line);
2792                         if (g_slist_length(tokens) != 2) {
2793                                 msg("Invalid message");
2794                                 goto OUT;
2795                         }
2796                         res.apdu_resp_length = atoi(g_slist_nth_data(tokens, 0)) / 2;
2797
2798                         tmp = util_removeQuotes(g_slist_nth_data(tokens, 1));
2799                         decoded_data = util_hexStringToBytes(tmp);
2800
2801                         memcpy((char *)res.apdu_resp, decoded_data, res.apdu_resp_length);
2802                         g_free(tmp);
2803                         g_free(decoded_data);
2804                         res.result = SIM_ACCESS_SUCCESS;
2805                 }
2806         } else {
2807                 dbg("RESPONSE NOK");
2808         }
2809
2810 OUT:
2811         /* Send Response */
2812         if (ur) {
2813                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2814                                                         sizeof(struct tresp_sim_transmit_apdu), &res);
2815         }
2816         tcore_at_tok_free(tokens);
2817         dbg("Exit");
2818 }
2819
2820 static void on_response_get_atr(TcorePending *p, int data_len, const void *data, void *user_data)
2821 {
2822         const TcoreATResponse *resp = data;
2823         UserRequest *ur = NULL;
2824         GSList *tokens = NULL;
2825         struct tresp_sim_get_atr res;
2826         const char *line;
2827
2828         dbg("Entry");
2829
2830         memset(&res, 0, sizeof(struct tresp_sim_get_atr));
2831         ur = tcore_pending_ref_user_request(p);
2832
2833         res.result = SIM_ACCESS_FAILED;
2834         if (resp->success > 0) {
2835                 dbg("RESPONSE OK");
2836                 if (resp->lines) {
2837                         char *tmp = NULL;
2838                         char *decoded_data = NULL;
2839                         line = (const char *)resp->lines->data;
2840                         tokens = tcore_at_tok_new(line);
2841                         if (g_slist_length(tokens) < 1) {
2842                                 msg("Invalid message");
2843                                 goto OUT;
2844                         }
2845
2846                         tmp = util_removeQuotes(g_slist_nth_data(tokens, 0));
2847                         decoded_data = util_hexStringToBytes(tmp);
2848
2849                         res.atr_length = strlen(decoded_data);
2850                         memcpy((char *)res.atr, decoded_data, res.atr_length);
2851                         g_free(tmp);
2852                         g_free(decoded_data);
2853                         res.result = SIM_ACCESS_SUCCESS;
2854                 }
2855         } else {
2856                 dbg("RESPONSE NOK");
2857         }
2858
2859 OUT:
2860         /* Send Response */
2861         if (ur) {
2862                 tcore_user_request_send_response(ur, _find_resp_command(ur),
2863                                                         sizeof(struct tresp_sim_get_atr), &res);
2864         }
2865         tcore_at_tok_free(tokens);
2866         dbg("Exit");
2867 }
2868
2869 static TReturn s_verify_pins(CoreObject *o, UserRequest *ur)
2870 {
2871         TcoreHal *hal = NULL;
2872         TcoreATRequest *req = NULL;
2873         TcorePending *pending = NULL;
2874         char *cmd_str = NULL;
2875         const struct treq_sim_verify_pins *req_data = NULL;
2876         struct s_sim_property *sp = NULL;
2877         TReturn ret = TCORE_RETURN_FAILURE;
2878
2879         dbg("Entry");
2880
2881         if ((o == NULL )|| (ur == NULL))
2882                 return TCORE_RETURN_EINVAL;
2883
2884         hal = tcore_object_get_hal(o);
2885         if (FALSE == tcore_hal_get_power_state(hal)) {
2886                 err("CP NOT READY");
2887                 return TCORE_RETURN_ENOSYS;
2888         }
2889
2890         sp = tcore_sim_ref_userdata(o);
2891         pending = tcore_pending_new(o, 0);
2892         req_data = tcore_user_request_ref_data(ur, NULL);
2893
2894         if (req_data->pin_type == SIM_PTYPE_PIN1) {
2895                 sp->current_sec_op = SEC_PIN1_VERIFY;
2896                 cmd_str = g_strdup_printf("AT+CPIN=\"%s\"", req_data->pin);
2897         } else if (req_data->pin_type == SIM_PTYPE_PIN2) {
2898                 sp->current_sec_op = SEC_PIN2_VERIFY;
2899                 cmd_str = g_strdup_printf("AT+CPIN2=\"%s\"", req_data->pin);
2900         } else if (req_data->pin_type == SIM_PTYPE_SIM) {
2901                 sp->current_sec_op = SEC_SIM_VERIFY;
2902                 cmd_str = g_strdup_printf("AT+CPIN=\"%s\"", req_data->pin);
2903         } else if (req_data->pin_type == SIM_PTYPE_ADM) {
2904                 sp->current_sec_op = SEC_ADM_VERIFY;
2905                 cmd_str = g_strdup_printf("AT+CPIN=\"%s\"", req_data->pin);
2906         } else {
2907                 return TCORE_RETURN_EINVAL;
2908         }
2909
2910         req = tcore_at_request_new(cmd_str, NULL, TCORE_AT_NO_RESULT);
2911         g_free(cmd_str);
2912
2913         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
2914                                 req->cmd, req->prefix, strlen(req->cmd));
2915
2916         tcore_pending_set_request_data(pending, 0, req);
2917         tcore_pending_set_response_callback(pending, on_response_verify_pins, hal);
2918         tcore_pending_link_user_request(pending, ur);
2919         ret = tcore_hal_send_request(hal, pending);
2920
2921         dbg("Exit");
2922         return ret;
2923 }
2924
2925 static TReturn s_verify_puks(CoreObject *o, UserRequest *ur)
2926 {
2927         TcoreHal *hal = NULL;
2928         TcoreATRequest *req = NULL;
2929         TcorePending *pending = NULL;
2930         char *cmd_str = NULL;
2931         const struct treq_sim_verify_puks *req_data;
2932         struct s_sim_property *sp = NULL;
2933         TReturn ret = TCORE_RETURN_FAILURE;
2934
2935         dbg("Entry");
2936
2937         if ((o == NULL )|| (ur == NULL))
2938                 return TCORE_RETURN_EINVAL;
2939
2940         hal = tcore_object_get_hal(o);
2941         if (FALSE == tcore_hal_get_power_state(hal)) {
2942                 err("CP NOT READY");
2943                 return TCORE_RETURN_ENOSYS;
2944         }
2945
2946         sp = tcore_sim_ref_userdata(o);
2947         pending = tcore_pending_new(o, 0);
2948         req_data = tcore_user_request_ref_data(ur, NULL);
2949
2950         if (req_data->puk_type == SIM_PTYPE_PUK1) {
2951                 sp->current_sec_op = SEC_PUK1_VERIFY;
2952                 cmd_str = g_strdup_printf("AT+CPIN=\"%s\", \"%s\"", req_data->puk, req_data->pin);
2953         } else if (req_data->puk_type == SIM_PTYPE_PUK2) {
2954                 sp->current_sec_op = SEC_PUK2_VERIFY;
2955                 cmd_str = g_strdup_printf("AT+CPIN2=\"%s\", \"%s\"", req_data->puk, req_data->pin);
2956         } else {
2957                 return TCORE_RETURN_EINVAL;
2958         }
2959
2960         req = tcore_at_request_new(cmd_str, NULL, TCORE_AT_NO_RESULT);
2961         g_free(cmd_str);
2962
2963         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
2964                                 req->cmd, req->prefix, strlen(req->cmd));
2965
2966         tcore_pending_set_request_data(pending, 0, req);
2967         tcore_pending_set_response_callback(pending, on_response_verify_puks, hal);
2968         tcore_pending_link_user_request(pending, ur);
2969         ret = tcore_hal_send_request(hal, pending);
2970
2971         dbg("Exit");
2972         return ret;
2973 }
2974
2975 static TReturn s_change_pins(CoreObject *o, UserRequest *ur)
2976 {
2977         TcoreHal *hal = NULL;
2978         TcoreATRequest *req = NULL;
2979         TcorePending *pending = NULL;
2980         char *cmd_str = NULL;
2981         const struct treq_sim_change_pins *req_data;
2982         struct s_sim_property *sp = NULL;
2983         char *pin1 = "SC";
2984         char *pin2 = "P2";
2985         TReturn ret = TCORE_RETURN_FAILURE;
2986
2987         dbg("Entry");
2988
2989         if ((o == NULL )|| (ur == NULL))
2990                 return TCORE_RETURN_EINVAL;
2991
2992         hal = tcore_object_get_hal(o);
2993         if (FALSE == tcore_hal_get_power_state(hal)) {
2994                 err("CP NOT READY");
2995                 return TCORE_RETURN_ENOSYS;
2996         }
2997
2998         sp = tcore_sim_ref_userdata(o);
2999         pending = tcore_pending_new(o, 0);
3000         req_data = tcore_user_request_ref_data(ur, NULL);
3001
3002         if (req_data->type == SIM_PTYPE_PIN1) {
3003                 sp->current_sec_op = SEC_PIN1_CHANGE;
3004                 cmd_str = g_strdup_printf("AT+CPWD=\"%s\",\"%s\",\"%s\"", pin1, req_data->old_pin, req_data->new_pin);
3005         } else if (req_data->type == SIM_PTYPE_PIN2) {
3006                 sp->current_sec_op = SEC_PIN2_CHANGE;
3007                 cmd_str = g_strdup_printf("AT+CPWD=\"%s\",\"%s\",\"%s\"", pin2, req_data->old_pin, req_data->new_pin);
3008         } else {
3009                 return TCORE_RETURN_EINVAL;
3010         }
3011         req = tcore_at_request_new(cmd_str, NULL, TCORE_AT_NO_RESULT);
3012         g_free(cmd_str);
3013
3014         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
3015                                 req->cmd, req->prefix, strlen(req->cmd));
3016
3017         tcore_pending_set_request_data(pending, 0, req);
3018         tcore_pending_set_response_callback(pending, on_response_change_pins, hal);
3019         tcore_pending_link_user_request(pending, ur);
3020         ret = tcore_hal_send_request(hal, pending);
3021
3022         dbg("Exit");
3023         return ret;
3024 }
3025
3026 static TReturn s_get_facility_status(CoreObject *o, UserRequest *ur)
3027 {
3028         TcoreHal *hal = NULL;
3029         TcoreATRequest *req = NULL;
3030         TcorePending *pending = NULL;
3031         char *cmd_str = NULL;
3032         const struct treq_sim_get_facility_status *req_data;
3033         struct tresp_sim_get_facility_status *res;
3034         char *fac = "SC";
3035         int mode = 2;    /* 0:unlock, 1:lock, 2:query*/
3036         TReturn ret = TCORE_RETURN_FAILURE;
3037
3038         dbg("Entry");
3039
3040         if ((o == NULL )|| (ur == NULL))
3041                 return TCORE_RETURN_EINVAL;
3042
3043         hal = tcore_object_get_hal(o);
3044         if (FALSE == tcore_hal_get_power_state(hal)) {
3045                 err("CP NOT READY");
3046                 return TCORE_RETURN_ENOSYS;
3047         }
3048
3049         pending = tcore_pending_new(o, 0);
3050         req_data = tcore_user_request_ref_data(ur, NULL);
3051
3052         res = g_try_new0(struct tresp_sim_get_facility_status, 1);
3053         if (!res)
3054                 return TCORE_RETURN_ENOMEM;
3055
3056         res->type = req_data->type;
3057
3058         if (req_data->type == SIM_FACILITY_PS) {
3059                 fac = "PS";               /*PH-SIM, Lock PHone to SIM/UICC card*/
3060         } else if (req_data->type == SIM_FACILITY_SC) {
3061                 fac = "SC";               /*Lock SIM/UICC card, simply PIN1*/
3062         } else if (req_data->type == SIM_FACILITY_FD) {
3063                 fac = "FD";               /*Fixed Dialing Number feature, need PIN2*/
3064         } else if (req_data->type == SIM_FACILITY_PN) {
3065                 fac = "PN";               /*Network Personalization*/
3066         } else if (req_data->type == SIM_FACILITY_PU) {
3067                 fac = "PU";               /*network sUbset Personalization*/
3068         } else if (req_data->type == SIM_FACILITY_PP) {
3069                 fac = "PP";               /*service Provider Personalization*/
3070         } else if (req_data->type == SIM_FACILITY_PC) {
3071                 fac = "PC";               /*Corporate Personalization*/
3072         } else {
3073                 return TCORE_RETURN_EINVAL;
3074         }
3075         cmd_str = g_strdup_printf("AT+CLCK=\"%s\", %d", fac, mode);
3076         req = tcore_at_request_new(cmd_str, "+CLCK:", TCORE_AT_SINGLELINE);
3077         g_free(cmd_str);
3078
3079         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
3080                                 req->cmd, req->prefix, strlen(req->cmd));
3081
3082         tcore_pending_set_request_data(pending, 0, req);
3083         tcore_pending_set_response_callback(pending, on_response_get_facility_status, res);
3084         tcore_pending_link_user_request(pending, ur);
3085         ret = tcore_hal_send_request(hal, pending);
3086
3087         dbg("Exit");
3088         return ret;
3089 }
3090
3091 static TReturn s_enable_facility(CoreObject *o, UserRequest *ur)
3092 {
3093         TcoreHal *hal = NULL;
3094         TcoreATRequest *req = NULL;
3095         TcorePending *pending = NULL;
3096         char *cmd_str = NULL;
3097         const struct treq_sim_enable_facility *req_data;
3098         struct s_sim_property *sp = NULL;
3099         char *fac = "SC";
3100         int mode = 1;    /* 0:unlock, 1:lock, 2:query*/
3101         TReturn ret = TCORE_RETURN_FAILURE;
3102
3103         dbg("Entry");
3104
3105         if ((o == NULL )|| (ur == NULL))
3106                 return TCORE_RETURN_EINVAL;
3107
3108         hal = tcore_object_get_hal(o);
3109         if (FALSE == tcore_hal_get_power_state(hal)) {
3110                 err("CP NOT READY");
3111                 return TCORE_RETURN_ENOSYS;
3112         }
3113
3114         sp = tcore_sim_ref_userdata(o);
3115         pending = tcore_pending_new(o, 0);
3116         req_data = tcore_user_request_ref_data(ur, NULL);
3117
3118         if (req_data->type == SIM_FACILITY_PS) {
3119                 fac = "PS";               /*PH-SIM, Lock PHone to SIM/UICC card*/
3120                 sp->current_sec_op = SEC_SIM_ENABLE;
3121         } else if (req_data->type == SIM_FACILITY_SC) {
3122                 fac = "SC";               /*Lock SIM/UICC card, simply PIN1*/
3123                 sp->current_sec_op = SEC_PIN1_ENABLE;
3124         } else if (req_data->type == SIM_FACILITY_FD) {
3125                 fac = "FD";               /*Fixed Dialing Number feature, need PIN2*/
3126                 sp->current_sec_op = SEC_FDN_ENABLE;
3127         } else if (req_data->type == SIM_FACILITY_PN) {
3128                 fac = "PN";               /*Network Personalization*/
3129                 sp->current_sec_op = SEC_NET_ENABLE;
3130         } else if (req_data->type == SIM_FACILITY_PU) {
3131                 fac = "PU";               /*network sUbset Personalization*/
3132                 sp->current_sec_op = SEC_NS_ENABLE;
3133         } else if (req_data->type == SIM_FACILITY_PP) {
3134                 fac = "PP";               /*service Provider Personalization*/
3135                 sp->current_sec_op = SEC_SP_ENABLE;
3136         } else if (req_data->type == SIM_FACILITY_PC) {
3137                 fac = "PC";               /*Corporate Personalization*/
3138                 sp->current_sec_op = SEC_CP_ENABLE;
3139         } else {
3140                 return TCORE_RETURN_EINVAL;
3141         }
3142         cmd_str = g_strdup_printf("AT+CLCK=\"%s\", %d, \"%s\"", fac, mode, req_data->password);
3143         req = tcore_at_request_new(cmd_str, "+CLCK:", TCORE_AT_SINGLELINE);
3144         g_free(cmd_str);
3145
3146         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
3147                                 req->cmd, req->prefix, strlen(req->cmd));
3148
3149         tcore_pending_set_request_data(pending, 0, req);
3150         tcore_pending_set_response_callback(pending, on_response_enable_facility, hal);
3151         tcore_pending_link_user_request(pending, ur);
3152         ret = tcore_hal_send_request(hal, pending);
3153
3154         dbg("Exit");
3155         return ret;
3156 }
3157
3158 static TReturn s_disable_facility(CoreObject *o, UserRequest *ur)
3159 {
3160         TcoreHal *hal;
3161         TcoreATRequest *req;
3162         TcorePending *pending = NULL;
3163         char *cmd_str = NULL;
3164         const struct treq_sim_enable_facility *req_data;
3165         struct s_sim_property *sp = NULL;
3166         char *fac = "SC";
3167         int mode = 0;    /* 0:unlock, 1:lock, 2:query*/
3168         TReturn ret = TCORE_RETURN_FAILURE;
3169
3170         dbg("Entry");
3171
3172         if ((o == NULL )|| (ur == NULL))
3173                 return TCORE_RETURN_EINVAL;
3174
3175         hal = tcore_object_get_hal(o);
3176         if (FALSE == tcore_hal_get_power_state(hal)) {
3177                 err("CP NOT READY");
3178                 return TCORE_RETURN_ENOSYS;
3179         }
3180
3181         sp = tcore_sim_ref_userdata(o);
3182         pending = tcore_pending_new(o, 0);
3183         req_data = tcore_user_request_ref_data(ur, NULL);
3184
3185         if (req_data->type == SIM_FACILITY_PS) {
3186                 fac = "PS";               /*PH-SIM, Lock PHone to SIM/UICC card*/
3187                 sp->current_sec_op = SEC_SIM_DISABLE;
3188         } else if (req_data->type == SIM_FACILITY_SC) {
3189                 fac = "SC";               /*Lock SIM/UICC card, simply PIN1*/
3190                 sp->current_sec_op = SEC_PIN1_DISABLE;
3191         } else if (req_data->type == SIM_FACILITY_FD) {
3192                 fac = "FD";               /*Fixed Dialing Number feature, need PIN2*/
3193                 sp->current_sec_op = SEC_FDN_DISABLE;
3194         } else if (req_data->type == SIM_FACILITY_PN) {
3195                 fac = "PN";               /*Network Personalization*/
3196                 sp->current_sec_op = SEC_NET_DISABLE;
3197         } else if (req_data->type == SIM_FACILITY_PU) {
3198                 fac = "PU";               /*network sUbset Personalization*/
3199                 sp->current_sec_op = SEC_NS_DISABLE;
3200         } else if (req_data->type == SIM_FACILITY_PP) {
3201                 fac = "PP";               /*service Provider Personalization*/
3202                 sp->current_sec_op = SEC_SP_DISABLE;
3203         } else if (req_data->type == SIM_FACILITY_PC) {
3204                 fac = "PC";               /*Corporate Personalization*/
3205                 sp->current_sec_op = SEC_CP_DISABLE;
3206         } else {
3207                 return TCORE_RETURN_EINVAL;
3208         }
3209         cmd_str = g_strdup_printf("AT+CLCK=\"%s\", %d, \"%s\"", fac, mode, req_data->password);
3210         req = tcore_at_request_new(cmd_str, "+CLCK:", TCORE_AT_SINGLELINE);
3211         g_free(cmd_str);
3212
3213         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
3214                                 req->cmd, req->prefix, strlen(req->cmd));
3215
3216         tcore_pending_set_request_data(pending, 0, req);
3217         tcore_pending_set_response_callback(pending, on_response_disable_facility, hal);
3218         tcore_pending_link_user_request(pending, ur);
3219         ret = tcore_hal_send_request(hal, pending);
3220
3221         dbg("Exit");
3222         return ret;
3223 }
3224
3225 static TReturn s_get_lock_info(CoreObject *o, UserRequest *ur)
3226 {
3227         TcoreHal *hal = NULL;
3228         TcoreATRequest *req = NULL;
3229         TcorePending *pending = NULL;
3230         char *cmd_str = NULL;
3231         int lock_type = 0;
3232         const struct treq_sim_get_lock_info *req_data;
3233         struct s_sim_property *sp = NULL;
3234
3235         dbg("Entry");
3236
3237         hal = tcore_object_get_hal(o);
3238
3239         sp = tcore_sim_ref_userdata(o);
3240         pending = tcore_pending_new(o, 0);
3241         req_data = tcore_user_request_ref_data(ur, NULL);
3242
3243         if ((o == NULL )|| (ur == NULL))
3244                 return TCORE_RETURN_EINVAL;
3245
3246         switch (req_data->type) {
3247         case SIM_FACILITY_PS:
3248                 lock_type = 9; // IMSI lock
3249                 break;
3250
3251         case SIM_FACILITY_SC:
3252                 lock_type = 1;
3253                 break;
3254
3255         case SIM_FACILITY_FD:
3256                 lock_type = 2;
3257                 break;
3258
3259         case SIM_FACILITY_PN:
3260                 lock_type = 5;
3261                 break;
3262
3263         case SIM_FACILITY_PU:
3264                 lock_type = 6;
3265                 break;
3266
3267         case SIM_FACILITY_PP:
3268                 lock_type = 7;
3269                 break;
3270
3271         case SIM_FACILITY_PC:
3272                 lock_type = 8;
3273                 break;
3274
3275         default:
3276                 break;
3277         }
3278         cmd_str = g_strdup_printf("AT+XPINCNT=%d", lock_type);
3279         req = tcore_at_request_new(cmd_str, "+XPINCNT:", TCORE_AT_SINGLELINE);
3280         g_free(cmd_str);
3281
3282         dbg("Command: [%s] Prefix(if any): [%s], Command length: [%d]",
3283                                 req->cmd, req->prefix, strlen(req->cmd));
3284
3285         tcore_pending_set_request_data(pending, 0, req);
3286         tcore_pending_set_response_callback(pending, on_response_get_lock_info, hal);
3287         tcore_pending_link_user_request(pending, ur);
3288         tcore_hal_send_request(hal, pending);
3289
3290         dbg("Exit");
3291         return TCORE_RETURN_SUCCESS;
3292 }
3293
3294 static TReturn s_read_file(CoreObject *o, UserRequest *ur)
3295 {
3296         TReturn api_ret = TCORE_RETURN_SUCCESS;
3297         enum tcore_request_command command;
3298
3299         dbg("Entry");
3300
3301         if ((o == NULL )|| (ur == NULL))
3302                 return TCORE_RETURN_EINVAL;
3303
3304         command = tcore_user_request_get_command(ur);
3305         if (FALSE == tcore_hal_get_power_state(tcore_object_get_hal(o))) {
3306                 err("CP NOT READY");
3307                 return TCORE_RETURN_ENOSYS;
3308         }
3309
3310         switch (command) {
3311         case TREQ_SIM_GET_ECC:
3312                 api_ret = _get_file_info(o, ur, SIM_EF_ECC);
3313                 break;
3314
3315         case TREQ_SIM_GET_LANGUAGE:
3316                 if (tcore_sim_get_type(o) == SIM_TYPE_GSM)
3317                         api_ret = _get_file_info(o, ur, SIM_EF_ELP);
3318                 else if (tcore_sim_get_type(o) == SIM_TYPE_USIM)
3319                         api_ret = _get_file_info(o, ur, SIM_EF_LP);
3320                 else
3321                         api_ret = TCORE_RETURN_ENOSYS;
3322                 break;
3323
3324         case TREQ_SIM_GET_ICCID:
3325                 api_ret = _get_file_info(o, ur, SIM_EF_ICCID);
3326                 break;
3327
3328         case TREQ_SIM_GET_MAILBOX:
3329                 if (tcore_sim_get_cphs_status(o))
3330                         api_ret = _get_file_info(o, ur, SIM_EF_CPHS_MAILBOX_NUMBERS);
3331                 else
3332                         api_ret = _get_file_info(o, ur, SIM_EF_MBDN);
3333                 break;
3334
3335         case TREQ_SIM_GET_CALLFORWARDING:
3336                 if (tcore_sim_get_cphs_status(o))
3337                         api_ret = _get_file_info(o, ur, SIM_EF_CPHS_CALL_FORWARD_FLAGS);
3338                 else
3339                         api_ret = _get_file_info(o, ur, SIM_EF_USIM_CFIS);
3340                 break;
3341
3342         case TREQ_SIM_GET_MESSAGEWAITING:
3343                 if (tcore_sim_get_cphs_status(o))
3344                         api_ret = _get_file_info(o, ur, SIM_EF_CPHS_VOICE_MSG_WAITING);
3345                 else
3346                         api_ret = _get_file_info(o, ur, SIM_EF_USIM_MWIS);
3347                 break;
3348
3349         case TREQ_SIM_GET_CPHS_INFO:
3350                 api_ret = _get_file_info(o, ur, SIM_EF_CPHS_CPHS_INFO);
3351                 break;
3352
3353         case TREQ_SIM_GET_MSISDN:
3354                 api_ret = _get_file_info(o, ur, SIM_EF_MSISDN);
3355                 break;
3356
3357         case TREQ_SIM_GET_SPN:
3358                 dbg("enter case SPN");
3359                 api_ret = _get_file_info(o, ur, SIM_EF_SPN);
3360                 break;
3361
3362         case TREQ_SIM_GET_SPDI:
3363                 api_ret = _get_file_info(o, ur, SIM_EF_SPDI);
3364                 break;
3365
3366         case TREQ_SIM_GET_OPL:
3367                 api_ret = _get_file_info(o, ur, SIM_EF_OPL);
3368                 break;
3369
3370         case TREQ_SIM_GET_PNN:
3371                 api_ret = _get_file_info(o, ur, SIM_EF_PNN);
3372                 break;
3373
3374         case TREQ_SIM_GET_CPHS_NETNAME:
3375                 api_ret = _get_file_info(o, ur, SIM_EF_CPHS_OPERATOR_NAME_STRING);
3376                 break;
3377
3378         case TREQ_SIM_GET_OPLMNWACT:
3379                 api_ret = _get_file_info(o, ur, SIM_EF_OPLMN_ACT);
3380                 break;
3381
3382         default:
3383                 dbg("error - not handled read treq command[%d]", command);
3384                 api_ret = TCORE_RETURN_EINVAL;
3385                 break;
3386         }
3387         dbg("Exit");
3388         return api_ret;
3389 }
3390
3391 static TReturn s_update_file(CoreObject *o, UserRequest *ur)
3392 {
3393         TcoreHal *hal;
3394         char *cmd_str = NULL;
3395         TReturn ret = TCORE_RETURN_SUCCESS;
3396         char *encoded_data = NULL;
3397         int encoded_len = 0;
3398         enum tcore_request_command command;
3399         enum tel_sim_file_id ef = SIM_EF_INVALID;
3400         const struct treq_sim_set_callforwarding *cf;
3401         const struct treq_sim_set_language *cl;
3402         struct s_sim_property file_meta = {0, };
3403         int p1 = 0;
3404         int p2 = 0;
3405         int p3 = 0;
3406         int cmd = 0;
3407         int out_length = 0;
3408         int trt = 0;
3409         struct tel_sim_language sim_language;
3410         char *tmp = NULL;
3411         gboolean result;
3412
3413         command = tcore_user_request_get_command(ur);
3414
3415         dbg("Entry");
3416
3417         if ((o == NULL )|| (ur == NULL)) {
3418                 return TCORE_RETURN_EINVAL;
3419         }
3420
3421         hal = tcore_object_get_hal(o);
3422         if (FALSE == tcore_hal_get_power_state(hal)) {
3423                 err("CP NOT READY");
3424                 return TCORE_RETURN_ENOSYS;
3425         }
3426
3427         switch (command) {
3428         case TREQ_SIM_SET_LANGUAGE:
3429                 cl = tcore_user_request_ref_data(ur, NULL);
3430                 memset(&sim_language, 0x00, sizeof(struct tel_sim_language));
3431                 cmd = 214;
3432
3433                 sim_language.language_count = 1;
3434                 sim_language.language[0] = cl->language;
3435                 dbg("language %d", cl->language);
3436
3437                 if (tcore_sim_get_type(o) == SIM_TYPE_GSM) {
3438                         dbg("2G");
3439                         ef = SIM_EF_LP;
3440                         tmp = tcore_sim_encode_lp(&out_length, &sim_language);
3441
3442                         encoded_data = (char *)malloc(2 * (sim_language.language_count) + 1);
3443                         memset(encoded_data, 0x00, (2 * sim_language.language_count) + 1);
3444                         result = util_byte_to_hex(tmp, encoded_data, out_length);
3445
3446                         p1 = 0;
3447                         p2 = 0;
3448                         p3 = out_length;
3449                         dbg("encoded_data - %s ---", encoded_data);
3450                         dbg("out_length - %d ---", out_length);
3451                 } else if (tcore_sim_get_type(o) == SIM_TYPE_USIM) {
3452                         dbg("3G");
3453                         ef = SIM_EF_LP;
3454                         tmp = tcore_sim_encode_li(&out_length, &sim_language);
3455
3456                         encoded_data = (char *)malloc(2 * (out_length) + 1);
3457                         memset(encoded_data, 0x00, (2 * out_length) + 1);
3458                         result = util_byte_to_hex(tmp, encoded_data, out_length);
3459
3460                         p1 = 0;
3461                         p2 = 0;
3462                         p3 = out_length;
3463                         dbg("encoded_data - %s ---", encoded_data);
3464                         dbg("out_length - %d ---", out_length);
3465                 } else {
3466                         ret = TCORE_RETURN_ENOSYS;
3467                 }
3468                 break;
3469
3470         case TREQ_SIM_SET_CALLFORWARDING:
3471                 cf = tcore_user_request_ref_data(ur, NULL);
3472                 if (tcore_sim_get_cphs_status(o)) {
3473                         tmp = tcore_sim_encode_cff((const struct tel_sim_cphs_cf*)&cf->cphs_cf);
3474                         ef = SIM_EF_CPHS_CALL_FORWARD_FLAGS;
3475                         p1 = 0;
3476                         p2 = 0;
3477                         p3 = strlen(tmp);
3478                         encoded_data = (char *)g_try_malloc0(2 * (p3) + 1);
3479                         result = util_byte_to_hex(tmp, encoded_data, p3);
3480                         cmd = 214;         /*command - 214 : UPDATE BINARY*/
3481                 } else {
3482                         tmp = tcore_sim_encode_cfis(&encoded_len, (const struct tel_sim_cfis*)&cf->cf);
3483                         ef = SIM_EF_USIM_CFIS;
3484                         p1 = 1;
3485                         p2 = 0x04;
3486                         p3 = encoded_len;
3487                         encoded_data = (char *)g_try_malloc0(2 * (encoded_len) + 1);
3488                         result = util_byte_to_hex(tmp, encoded_data, encoded_len);
3489                         cmd = 220;         /*command - 220 : UPDATE RECORD*/
3490                 }
3491                 break;
3492
3493         default:
3494                 dbg("error - not handled update treq command[%d]", command);
3495                 ret = TCORE_RETURN_EINVAL;
3496                 break;
3497         }
3498
3499         file_meta.file_id = ef;
3500         dbg("File ID: [0x%x]", file_meta.file_id);
3501
3502         trt = tcore_user_request_set_metainfo(ur,
3503                                                 sizeof(struct s_sim_property), &file_meta);
3504         dbg("trt[%d]", trt);
3505
3506         cmd_str = g_strdup_printf("AT+CRSM=%d,%d,%d,%d,%d,\"%s\"", cmd, ef, p1, p2, p3, encoded_data);
3507
3508         ret = tcore_prepare_and_send_at_request(o, cmd_str, "+CRSM:",
3509                                                                 TCORE_AT_SINGLELINE, ur,
3510                                                                 on_response_update_file, hal,
3511                                                                 NULL, NULL);
3512
3513         g_free(cmd_str);
3514         g_free(encoded_data);
3515         if (tmp) {
3516                 free(tmp);
3517         }
3518
3519         dbg("Exit");
3520         return ret;
3521 }
3522
3523 static TReturn s_transmit_apdu(CoreObject *o, UserRequest *ur)
3524 {
3525         const struct treq_sim_transmit_apdu *req_data;
3526         TcoreHal *hal = NULL;
3527         char *cmd_str = NULL;
3528         char *apdu = NULL;
3529         int result = 0;
3530         TReturn ret = TCORE_RETURN_FAILURE;
3531
3532         dbg("Entry");
3533
3534         if ((o == NULL )|| (ur == NULL))
3535                 return TCORE_RETURN_EINVAL;
3536
3537         hal = tcore_object_get_hal(o);
3538         if (FALSE == tcore_hal_get_power_state(hal)) {
3539                 err("CP NOT READY");
3540                 return TCORE_RETURN_ENOSYS;
3541         }
3542
3543         req_data = tcore_user_request_ref_data(ur, NULL);
3544
3545         apdu = (char *)g_try_malloc0((2 * req_data->apdu_length) + 1);
3546         result = util_byte_to_hex((const char *)req_data->apdu, apdu, req_data->apdu_length);
3547         cmd_str = g_strdup_printf("AT+CSIM=%d,\"%s\"", strlen(apdu), apdu);
3548
3549         ret = tcore_prepare_and_send_at_request(o, cmd_str, "+CSIM:",
3550                                                                 TCORE_AT_SINGLELINE, ur,
3551                                                                 on_response_transmit_apdu, hal,
3552                                                                 NULL, NULL);
3553         g_free(cmd_str);
3554         g_free(apdu);
3555
3556         dbg("Exit");
3557         return ret;
3558 }
3559
3560 static TReturn s_get_atr(CoreObject *o, UserRequest *ur)
3561 {
3562         TcoreHal *hal = NULL;
3563
3564         dbg("Entry");
3565
3566         if ((o == NULL )|| (ur == NULL)) {
3567                 err("Invalid parameters");
3568                 return TCORE_RETURN_EINVAL;
3569         }
3570
3571         hal = tcore_object_get_hal(o);
3572         if (FALSE == tcore_hal_get_power_state(hal)) {
3573                 err("CP NOT READY");
3574                 return TCORE_RETURN_ENOSYS;
3575         }
3576
3577         return tcore_prepare_and_send_at_request(o, "AT+XGATR", "+XGATR:",
3578                                                                 TCORE_AT_SINGLELINE, ur,
3579                                                                 on_response_get_atr, hal,
3580                                                                 NULL, NULL);
3581 }
3582
3583 /* SIM Operations */
3584 static struct tcore_sim_operations sim_ops = {
3585         .verify_pins = s_verify_pins,
3586         .verify_puks = s_verify_puks,
3587         .change_pins = s_change_pins,
3588         .get_facility_status = s_get_facility_status,
3589         .enable_facility = s_enable_facility,
3590         .disable_facility = s_disable_facility,
3591         .get_lock_info = s_get_lock_info,
3592         .read_file = s_read_file,
3593         .update_file = s_update_file,
3594         .transmit_apdu = s_transmit_apdu,
3595         .get_atr = s_get_atr,
3596         .req_authentication = NULL,
3597 };
3598
3599 gboolean s_sim_init(TcorePlugin *cp, CoreObject *co_sim)
3600 {
3601         struct s_sim_property *file_meta;
3602
3603         dbg("Entry");
3604
3605         tcore_sim_override_ops(co_sim, &sim_ops);
3606
3607         file_meta = g_try_new0(struct s_sim_property, 1);
3608         if (file_meta == NULL)
3609                 return FALSE;
3610
3611         tcore_sim_link_userdata(co_sim, file_meta);
3612
3613         tcore_object_override_callback(co_sim, "+XLOCK:",
3614                                                         on_event_facility_lock_status, NULL);
3615         tcore_object_override_callback(co_sim, "+XSIM:",
3616                                                         on_event_pin_status, NULL);
3617
3618         tcore_server_add_notification_hook(tcore_plugin_ref_server(cp),
3619                                                         TNOTI_MODEM_POWER, on_hook_modem_power, co_sim);
3620
3621         dbg("Exit");
3622
3623         return TRUE;
3624 }
3625
3626 void s_sim_exit(TcorePlugin *cp, CoreObject *co_sim)
3627 {
3628         struct s_sim_property *file_meta;
3629
3630         file_meta = tcore_sim_ref_userdata(co_sim);
3631         g_free(file_meta);
3632
3633         dbg("Exit");
3634 }