| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 1 | /*============================================================================= |
| 2 | # FileName: lynq_sim.cpp |
| 3 | # Desc: about SIM API |
| 4 | # Author: mobiletek |
| 5 | # Version: V1.0 |
| 6 | # LastChange: 2021-12-29 |
| 7 | # History: |
| 8 | =============================================================================*/ |
| 9 | #include <stdio.h> |
| 10 | #include <sys/types.h> |
| 11 | #include <sys/socket.h> |
| 12 | #include <arpa/inet.h> |
| 13 | #include <string.h> |
| 14 | #include <unistd.h> |
| 15 | #include <binder/Parcel.h> |
| 16 | #include <log/log.h> |
| 17 | #include <cutils/jstring.h> |
| 18 | #include <pthread.h> |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 19 | #include <vendor-ril/telephony/ril.h> |
| 20 | #include <sys/socket.h> |
| 21 | #include <netinet/in.h> |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 22 | #include <arpa/inet.h> |
| jb.qi | 6b23ed4 | 2022-09-22 00:30:55 -0700 | [diff] [blame] | 23 | #include <errno.h> /*add for get recvfrom errorid on 20220921*/ |
| ll | 88f0078 | 2022-10-04 10:16:28 +0800 | [diff] [blame] | 24 | #include <sys/stat.h> |
| 25 | #include <fcntl.h> |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 26 | #include "lynq_sim.h" |
| lh | ee0d3b3 | 2024-04-25 03:54:48 -0700 | [diff] [blame] | 27 | #include "liblog/lynq_deflog.h" |
| 28 | #include "lynq_sim_urc.h" |
| 29 | |
| 30 | |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 31 | #define MAX_BUF 20 |
| 32 | #define MAX_NUM 80 |
| lh | ee0d3b3 | 2024-04-25 03:54:48 -0700 | [diff] [blame] | 33 | |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 34 | #define MAX_LEN 1024*8 |
| lh | ee0d3b3 | 2024-04-25 03:54:48 -0700 | [diff] [blame] | 35 | |
| 36 | #define USER_LOG_TAG "LYNQ_SIM" |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 37 | #define FLAG_TESS 0 |
| 38 | using ::android::Parcel; |
| 39 | #define DEST_PORT 8088 |
| 40 | #define DSET_IP_ADDRESS "127.0.0.1" |
| 41 | |
| 42 | typedef struct{ |
| 43 | int uToken; |
| 44 | int request; |
| 45 | int paramLen; |
| 46 | char param[MAX_LEN]; |
| 47 | }lynq_client_t; |
| 48 | |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 49 | /* socket文件描述符 */ |
| 50 | int len_addr_serv; |
| 51 | struct sockaddr_in addr_serv; |
| 52 | static int sock_fd = 0; |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 53 | int Global_uToken = 0; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 54 | static int default_cnt = 20; |
| ll | ab0f3e1 | 2022-07-20 11:59:51 +0000 | [diff] [blame] | 55 | static pthread_mutex_t g_lynq_sim_sendto_mutex; |
| ll | ba425bd | 2022-03-17 02:23:00 +0000 | [diff] [blame] | 56 | /** |
| 57 | * @brief mark call initialization state |
| 58 | * 0: deinit state |
| 59 | * 1: init state |
| 60 | */ |
| 61 | int g_lynq_sim_init_flag = 0; |
| 62 | |
| 63 | /** |
| 64 | * @brief lynq_req_sim_io need to send request |
| 65 | */ |
| 66 | char data_buf[32] = {0}; |
| 67 | char pin2_buf[32] = {0}; |
| 68 | char aidPtr_buf[32] = {0}; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 69 | |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 70 | /** |
| 71 | * @brief lynq_shutdown need |
| 72 | */ |
| ll | b15599d | 2022-04-01 07:50:08 +0000 | [diff] [blame] | 73 | char options_buf[32] = {0}; |
| 74 | char time_buf[32] = {0}; |
| 75 | char message_buf[32] = {0}; |
| 76 | |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 77 | typedef struct{ |
| 78 | int resp_type; |
| 79 | int token; |
| 80 | int request; |
| 81 | int slot_id; |
| 82 | int error; |
| 83 | }lynq_resp_t; |
| 84 | |
| lh | ee0d3b3 | 2024-04-25 03:54:48 -0700 | [diff] [blame] | 85 | static pthread_mutex_t s_sim_allow_data_mutex = PTHREAD_MUTEX_INITIALIZER; |
| 86 | static pthread_cond_t s_sim_allow_data_cond = PTHREAD_COND_INITIALIZER; |
| 87 | static int s_sim_allow_data_value = -1; |
| 88 | #define SIM_ALLOW_DATA_TIMEOUT 60*1000 |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 89 | |
| lh | ee0d3b3 | 2024-04-25 03:54:48 -0700 | [diff] [blame] | 90 | int waitAllowDataSignal(int mtime) |
| 91 | { |
| 92 | int ret = 0; |
| 93 | int sec = 0; |
| 94 | int usec = 0; |
| 95 | struct timeval now; |
| 96 | struct timespec timeout; |
| 97 | gettimeofday(&now,NULL); |
| 98 | sec = mtime/1000; |
| 99 | usec = mtime%1000; |
| 100 | timeout.tv_sec = now.tv_sec+sec; |
| 101 | timeout.tv_nsec = now.tv_usec*1000+usec*1000000; |
| 102 | pthread_mutex_lock(&s_sim_allow_data_mutex); |
| 103 | ret = pthread_cond_timedwait(&s_sim_allow_data_cond,&s_sim_allow_data_mutex,&timeout); |
| 104 | pthread_mutex_unlock(&s_sim_allow_data_mutex); |
| 105 | return ret; |
| 106 | } |
| 107 | |
| 108 | void sendAllowDataSignal(int value) |
| 109 | { |
| 110 | pthread_mutex_lock(&s_sim_allow_data_mutex); |
| 111 | s_sim_allow_data_value = value; |
| 112 | pthread_cond_signal(&s_sim_allow_data_cond); |
| 113 | pthread_mutex_unlock(&s_sim_allow_data_mutex); |
| 114 | return; |
| 115 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 116 | |
| 117 | /**@brief print solicied response msg's head information |
| 118 | * @param head [IN]: head information |
| 119 | * @return none |
| 120 | */ |
| 121 | void PrintHeader(lynq_resp_t& head) |
| 122 | { |
| 123 | RLOGD("resp_type=%d,token=%d,request=%d,slot_id=%d,error_code=%d",head.resp_type,head.token,head.request,head.slot_id,head.error); |
| 124 | } |
| 125 | |
| 126 | int GetHeader(Parcel* &p, lynq_resp_t& head, int request_id) |
| 127 | { |
| 128 | RLOGD("get header"); |
| 129 | if(p->dataAvail() > 0) |
| 130 | { |
| 131 | p->readInt32(&(head.resp_type)); |
| 132 | p->readInt32(&(head.token)); |
| 133 | p->readInt32(&(head.request)); |
| 134 | RLOGD("%s %d", __FUNCTION__, head.request); |
| 135 | p->readInt32(&(head.slot_id)); |
| 136 | p->readInt32(&(head.error)); |
| 137 | PrintHeader(head); |
| 138 | return head.error; |
| 139 | } |
| 140 | else |
| 141 | { |
| 142 | return RESULT_ERROR; |
| 143 | } |
| 144 | } |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 145 | int get_utoken() |
| 146 | { |
| 147 | return (Global_uToken++)%10000;/*0-10000*/ |
| 148 | } |
| 149 | int lynq_send_common_request(Parcel* p, int request_id, int argc, int cnt, int sim_count, const char* format,...) |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 150 | { |
| 151 | lynq_client_t client; |
| 152 | int ret; |
| 153 | int send_num; |
| 154 | int recv_num; |
| 155 | char res_data[MAX_LEN] = {0}; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 156 | client.uToken = get_utoken(); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 157 | if(request_id == RIL_REQUEST_SCREEN_STATE) |
| 158 | { |
| 159 | client.request = LYNQ_REQUEST_CHANGE_SCREEN_STATE; |
| 160 | } |
| 161 | else if(request_id == RIL_REQUEST_RADIO_POWER) |
| 162 | { |
| 163 | client.request = LYNQ_REQUEST_CHANGE_RADIO; |
| 164 | } |
| 165 | else |
| 166 | { |
| 167 | client.request = request_id; |
| 168 | } |
| 169 | client.paramLen = argc; |
| 170 | bzero(client.param,MAX_LEN); |
| 171 | if(argc!=0) |
| 172 | { |
| 173 | va_list args; |
| 174 | va_start(args, format); |
| 175 | vsnprintf(client.param, MAX_LEN, format, args); |
| 176 | va_end(args); |
| 177 | } |
| 178 | RLOGD("uToken=%d,request=%d,paralen=%d,param=%s",client.uToken,client.request,client.paramLen,client.param); |
| 179 | pthread_mutex_lock(&g_lynq_sim_sendto_mutex); |
| 180 | send_num = sendto(sock_fd,&client,sizeof(client),0,(struct sockaddr *)&addr_serv,len_addr_serv); |
| 181 | if(send_num <= 0) |
| 182 | { |
| 183 | RLOGD("send request fail, send num is %d", send_num); |
| 184 | pthread_mutex_unlock(&g_lynq_sim_sendto_mutex); |
| 185 | return LYNQ_E_SEND_REQUEST_FAIL; |
| 186 | } |
| 187 | lynq_resp_t head; |
| 188 | head.request = -1; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 189 | for(int i = 0; i < cnt; i++) |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 190 | { |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 191 | head.resp_type = -1; |
| 192 | head.token = -1; |
| 193 | head.request = -1; |
| 194 | head.slot_id = -1; |
| 195 | head.error = -1; |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 196 | recv_num = recvfrom(sock_fd,res_data,sizeof(char)*MAX_LEN, 0, (struct sockaddr *)&addr_serv,(socklen_t*)&len_addr_serv); |
| 197 | if(recv_num <= 0) |
| 198 | { |
| xy.he | 6930788 | 2024-04-26 18:14:53 +0800 | [diff] [blame] | 199 | #ifdef MODE_DSDS |
| 200 | if (errno == EAGAIN || errno == EWOULDBLOCK) |
| 201 | { |
| 202 | RLOGD("recv from timeout"); |
| 203 | pthread_mutex_unlock(&g_lynq_sim_sendto_mutex); |
| 204 | return LYNQ_E_TIME_OUT; |
| 205 | } |
| 206 | else |
| 207 | { |
| 208 | RLOGD("recv request fail, recv num is %d", recv_num); |
| 209 | pthread_mutex_unlock(&g_lynq_sim_sendto_mutex); |
| 210 | return recv_num; |
| 211 | } |
| 212 | #else |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 213 | RLOGD("recv request fail, recv num is %d", recv_num); |
| 214 | pthread_mutex_unlock(&g_lynq_sim_sendto_mutex); |
| 215 | return recv_num; |
| xy.he | 6930788 | 2024-04-26 18:14:53 +0800 | [diff] [blame] | 216 | #endif |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 217 | } |
| 218 | p->setData((uint8_t *)res_data,sizeof(char)*recv_num); |
| 219 | p->setDataPosition(0); |
| 220 | ret=GetHeader(p,head,request_id); |
| 221 | if(ret!=0) |
| 222 | { |
| 223 | RLOGD("%s %d get head error %d",__FUNCTION__,client.uToken,ret); |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 224 | |
| 225 | if (head.token != client.uToken) |
| 226 | { |
| 227 | RLOGD("head.token is %d != client.uToken is %d", head.token, client.uToken); |
| 228 | ret = RESULT_ERROR; |
| 229 | continue; |
| 230 | } |
| 231 | |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 232 | pthread_mutex_unlock(&g_lynq_sim_sendto_mutex); |
| 233 | return ret; |
| 234 | } |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 235 | if (head.token != client.uToken) |
| 236 | { |
| 237 | RLOGD("head.token is %d != client.uToken is %d", head.token, client.uToken); |
| 238 | ret = RESULT_ERROR; |
| 239 | continue; |
| 240 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 241 | if(request_id == head.request) |
| 242 | { |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 243 | sim_count--; |
| 244 | if(sim_count <= 0) |
| 245 | break; |
| 246 | else |
| 247 | continue; |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 248 | } |
| 249 | } |
| 250 | pthread_mutex_unlock(&g_lynq_sim_sendto_mutex); |
| 251 | return ret; |
| 252 | } |
| 253 | |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 254 | int lynq_sim_init(int utoken){ |
| lh | ee0d3b3 | 2024-04-25 03:54:48 -0700 | [diff] [blame] | 255 | LYLOGSET(LOG_DEBUG); |
| 256 | LYLOGEINIT(USER_LOG_TAG); |
| q.huang | f6a9ddc | 2023-12-08 20:23:56 +0800 | [diff] [blame] | 257 | RLOGE("%s start, parameter is %d", __func__,utoken); |
| 258 | |
| ll | ba425bd | 2022-03-17 02:23:00 +0000 | [diff] [blame] | 259 | if(g_lynq_sim_init_flag == 1) |
| 260 | { |
| 261 | RLOGD("lynq_sim_init failed"); |
| 262 | return -1; |
| 263 | } |
| 264 | g_lynq_sim_init_flag = 1; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 265 | if(utoken < 0){ |
| 266 | return -1; |
| 267 | } |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 268 | Global_uToken = utoken; |
| 269 | sock_fd = socket(AF_INET, SOCK_DGRAM, 0); |
| ll | 33334af | 2022-06-30 16:54:51 +0800 | [diff] [blame] | 270 | if (-1 == sock_fd) |
| 271 | { |
| 272 | return sock_fd; |
| 273 | } |
| lh | 8d29011 | 2023-10-22 20:53:06 -0700 | [diff] [blame] | 274 | |
| 275 | struct sockaddr_in liblynq_data_socket; |
| 276 | bzero(&liblynq_data_socket, sizeof(liblynq_data_socket)); |
| 277 | //set this lib socket config |
| 278 | liblynq_data_socket.sin_family = AF_INET; |
| 279 | liblynq_data_socket.sin_addr.s_addr = inet_addr(DSET_IP_ADDRESS); |
| 280 | int ret = bind(sock_fd, (struct sockaddr *)&liblynq_data_socket, sizeof(liblynq_data_socket)); |
| 281 | if (-1 == ret) |
| 282 | { |
| 283 | RLOGE("liblynq_data_socket bind fail,errno:%d",errno); |
| 284 | return -1; |
| 285 | } |
| 286 | |
| ll | 33334af | 2022-06-30 16:54:51 +0800 | [diff] [blame] | 287 | struct timeval timeOut; |
| ll | ab0f3e1 | 2022-07-20 11:59:51 +0000 | [diff] [blame] | 288 | timeOut.tv_sec = 60; |
| ll | 33334af | 2022-06-30 16:54:51 +0800 | [diff] [blame] | 289 | timeOut.tv_usec = 0; |
| 290 | if (setsockopt(sock_fd, SOL_SOCKET, SO_RCVTIMEO, &timeOut, sizeof(timeOut)) < 0) |
| 291 | { |
| lh | ee0d3b3 | 2024-04-25 03:54:48 -0700 | [diff] [blame] | 292 | RLOGD("time out setting failed\n"); |
| ll | 33334af | 2022-06-30 16:54:51 +0800 | [diff] [blame] | 293 | return -1; |
| 294 | } |
| q.huang | f6a9ddc | 2023-12-08 20:23:56 +0800 | [diff] [blame] | 295 | |
| lh | ee0d3b3 | 2024-04-25 03:54:48 -0700 | [diff] [blame] | 296 | memset(&addr_serv, 0, sizeof(addr_serv)); |
| 297 | addr_serv.sin_family = AF_INET; |
| 298 | addr_serv.sin_addr.s_addr = inet_addr(DSET_IP_ADDRESS); |
| 299 | addr_serv.sin_port = htons(DEST_PORT); |
| 300 | len_addr_serv = sizeof(addr_serv); |
| 301 | |
| 302 | #ifdef MODE_DSDS |
| 303 | ret = lynq_start_all_urc_socket_thread(); |
| 304 | if(ret != RESULT_OK) |
| 305 | { |
| 306 | LYERRLOG("init socket urc fail!!!"); |
| 307 | return LYNQ_E_INNER_ERROR; |
| 308 | } |
| 309 | #endif |
| q.huang | f6a9ddc | 2023-12-08 20:23:56 +0800 | [diff] [blame] | 310 | RLOGE("%s end suc", __func__); |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 311 | return 0; |
| 312 | } |
| 313 | |
| 314 | int lynq_sim_deinit(void){ |
| q.huang | f6a9ddc | 2023-12-08 20:23:56 +0800 | [diff] [blame] | 315 | |
| 316 | RLOGE("%s start", __func__); |
| 317 | |
| ll | ba425bd | 2022-03-17 02:23:00 +0000 | [diff] [blame] | 318 | if(g_lynq_sim_init_flag == 0) |
| 319 | { |
| 320 | RLOGD("lynq_sim_deinit failed"); |
| 321 | return -1; |
| 322 | } |
| lh | ee0d3b3 | 2024-04-25 03:54:48 -0700 | [diff] [blame] | 323 | |
| xy.he | 6930788 | 2024-04-26 18:14:53 +0800 | [diff] [blame] | 324 | #ifdef MODE_DSDS |
| lh | ee0d3b3 | 2024-04-25 03:54:48 -0700 | [diff] [blame] | 325 | lynq_close_all_urc_socket_thread(); |
| 326 | #endif |
| ll | ba425bd | 2022-03-17 02:23:00 +0000 | [diff] [blame] | 327 | g_lynq_sim_init_flag = 0; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 328 | close(sock_fd); |
| q.huang | f6a9ddc | 2023-12-08 20:23:56 +0800 | [diff] [blame] | 329 | |
| 330 | RLOGE("%s end suc", __func__); |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 331 | return 0; |
| 332 | } |
| 333 | |
| 334 | static char * lynqStrdupReadString(Parcel &p) { |
| 335 | size_t stringlen; |
| 336 | const char16_t *s16; |
| 337 | |
| 338 | s16 = p.readString16Inplace(&stringlen); |
| 339 | return strndup16to8(s16, stringlen); |
| 340 | } |
| 341 | |
| ll | ba425bd | 2022-03-17 02:23:00 +0000 | [diff] [blame] | 342 | /*If you need to use any API under lynq_sim, you mustfirst call the lynq_sim_init() function to initialize these functions.*/ |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 343 | int lynq_get_sim_status(int *card_status) |
| 344 | { |
| ll | 27dbe75 | 2022-08-10 00:33:52 -0700 | [diff] [blame] | 345 | if(g_lynq_sim_init_flag == 0) |
| 346 | { |
| 347 | return -1; |
| 348 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 349 | Parcel p; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 350 | int res = lynq_send_common_request(&p,RIL_REQUEST_GET_SIM_STATUS,0,default_cnt,1,""); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 351 | if(res != 0) |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 352 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 353 | RLOGD("function %s execute error", __FUNCTION__); |
| 354 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 355 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 356 | p.readInt32(card_status); |
| 357 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 358 | } |
| ll | ba425bd | 2022-03-17 02:23:00 +0000 | [diff] [blame] | 359 | |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 360 | int lynq_get_imsi(char buf[]) |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 361 | { |
| ll | 27dbe75 | 2022-08-10 00:33:52 -0700 | [diff] [blame] | 362 | if(g_lynq_sim_init_flag == 0) |
| 363 | { |
| 364 | return -1; |
| 365 | } |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 366 | Parcel p; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 367 | int res = lynq_send_common_request(&p,RIL_REQUEST_GET_IMSI,0,default_cnt,1,""); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 368 | if(res != 0) |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 369 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 370 | RLOGD("function %s execute error", __FUNCTION__); |
| 371 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 372 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 373 | char * test = lynqStrdupReadString(p); |
| 374 | memcpy(buf, test, strlen(test)); |
| 375 | free(test); |
| 376 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 377 | } |
| 378 | |
| 379 | |
| 380 | /*add by lei*/ |
| 381 | |
| 382 | int lynq_get_iccid(char buf[]){ |
| ll | 27dbe75 | 2022-08-10 00:33:52 -0700 | [diff] [blame] | 383 | if(g_lynq_sim_init_flag == 0) |
| 384 | { |
| 385 | return -1; |
| 386 | } |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 387 | Parcel p; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 388 | int res = lynq_send_common_request(&p,RIL_REQUEST_QUERY_ICCID,0,default_cnt,1,""); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 389 | if(res != 0) |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 390 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 391 | RLOGD("function %s execute error", __FUNCTION__); |
| 392 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 393 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 394 | char * test = lynqStrdupReadString(p); |
| 395 | memcpy(buf, test, strlen(test)); |
| 396 | free(test); |
| 397 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 398 | } |
| 399 | |
| 400 | int lynq_enable_pin(char *pin){ |
| ll | 27dbe75 | 2022-08-10 00:33:52 -0700 | [diff] [blame] | 401 | if(g_lynq_sim_init_flag == 0) |
| 402 | { |
| 403 | return -1; |
| 404 | } |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 405 | Parcel p; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 406 | int res = lynq_send_common_request(&p,RIL_REQUEST_SET_FACILITY_LOCK,4,default_cnt,1,"%s %s %s %s\n", "SC", pin, "11", "1"); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 407 | if(res != 0) |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 408 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 409 | RLOGD("function %s execute error", __FUNCTION__); |
| 410 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 411 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 412 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 413 | } |
| 414 | |
| ll | e6cc393 | 2022-08-18 06:06:39 -0700 | [diff] [blame] | 415 | int lynq_sim_power(int mode) |
| 416 | { |
| 417 | if(g_lynq_sim_init_flag == 0) |
| 418 | { |
| 419 | return -1; |
| 420 | } |
| ll | e6cc393 | 2022-08-18 06:06:39 -0700 | [diff] [blame] | 421 | Parcel p; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 422 | int res = lynq_send_common_request(&p,RIL_REQUEST_OEM_HOOK_RAW,1,default_cnt,1,"%s%d", "AT+ESIMPOWER=", mode); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 423 | if(res != 0) |
| 424 | { |
| 425 | RLOGD("function %s execute error", __FUNCTION__); |
| 426 | return res; |
| ll | e6cc393 | 2022-08-18 06:06:39 -0700 | [diff] [blame] | 427 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 428 | return res; |
| ll | e6cc393 | 2022-08-18 06:06:39 -0700 | [diff] [blame] | 429 | } |
| 430 | |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 431 | int lynq_disable_pin(char *pin){ |
| ll | 27dbe75 | 2022-08-10 00:33:52 -0700 | [diff] [blame] | 432 | if(g_lynq_sim_init_flag == 0) |
| 433 | { |
| 434 | return -1; |
| 435 | } |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 436 | Parcel p; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 437 | int res = lynq_send_common_request(&p,RIL_REQUEST_SET_FACILITY_LOCK,4,default_cnt,1,"%s %s %s %s\n", "SC", pin, "11", "0"); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 438 | if(res != 0) |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 439 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 440 | RLOGD("function %s execute error", __FUNCTION__); |
| 441 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 442 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 443 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 444 | } |
| 445 | |
| 446 | int lynq_query_pin_lock(char *pin,int buf[]){ |
| ll | 27dbe75 | 2022-08-10 00:33:52 -0700 | [diff] [blame] | 447 | if(g_lynq_sim_init_flag == 0) |
| 448 | { |
| 449 | return -1; |
| 450 | } |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 451 | Parcel p; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 452 | int res = lynq_send_common_request(&p,RIL_REQUEST_QUERY_FACILITY_LOCK,3,default_cnt,1,"%s %s %s\n", "SC", pin, "11"); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 453 | if(res != 0) |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 454 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 455 | RLOGD("function %s execute error", __FUNCTION__); |
| 456 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 457 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 458 | int num = -1; |
| 459 | p.readInt32(&num); |
| 460 | if(num > 0) |
| 461 | { |
| 462 | int *test = (int *)calloc(num, sizeof(int)); |
| 463 | for(int i =0; i <num; i++){ |
| 464 | p.readInt32(&test[i]); |
| 465 | buf[i] = test[i]; |
| 466 | } |
| 467 | free(test); |
| 468 | } |
| 469 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 470 | } |
| 471 | |
| 472 | int lynq_verify_pin(char *pin){ |
| ll | 27dbe75 | 2022-08-10 00:33:52 -0700 | [diff] [blame] | 473 | if(g_lynq_sim_init_flag == 0) |
| 474 | { |
| 475 | return -1; |
| 476 | } |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 477 | Parcel p; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 478 | int res = lynq_send_common_request(&p,RIL_REQUEST_ENTER_SIM_PIN,1,default_cnt,1,"%s\n", pin); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 479 | if(res != 0) |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 480 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 481 | RLOGD("function %s execute error", __FUNCTION__); |
| 482 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 483 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 484 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 485 | } |
| 486 | |
| 487 | int lynq_change_pin(char *old_pin, char *new_pin){ |
| ll | 27dbe75 | 2022-08-10 00:33:52 -0700 | [diff] [blame] | 488 | if(g_lynq_sim_init_flag == 0) |
| 489 | { |
| 490 | return -1; |
| 491 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 492 | int res = -1; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 493 | if(old_pin == NULL || new_pin == NULL) |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 494 | return res; |
| rjw | 5d2a50e | 2022-02-28 15:01:49 +0800 | [diff] [blame] | 495 | if(!strlen(new_pin)) |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 496 | return res; |
| ll | 3fe0346 | 2022-03-01 09:18:53 +0000 | [diff] [blame] | 497 | if(!strlen(old_pin)) |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 498 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 499 | Parcel p; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 500 | res = lynq_send_common_request(&p,RIL_REQUEST_CHANGE_SIM_PIN,2,default_cnt,1,"%s %s\n", old_pin, new_pin); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 501 | if(res != 0) |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 502 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 503 | RLOGD("function %s execute error", __FUNCTION__); |
| 504 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 505 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 506 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 507 | } |
| 508 | |
| 509 | int lynq_unlock_pin(char *puk, char *pin){ |
| ll | 27dbe75 | 2022-08-10 00:33:52 -0700 | [diff] [blame] | 510 | if(g_lynq_sim_init_flag == 0) |
| 511 | { |
| 512 | return -1; |
| 513 | } |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 514 | if(puk == NULL || pin == NULL) |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 515 | return -1; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 516 | Parcel p; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 517 | int res = lynq_send_common_request(&p,RIL_REQUEST_ENTER_SIM_PUK,2,default_cnt,1,"%s %s\n", puk, pin); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 518 | if(res != 0) |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 519 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 520 | RLOGD("function %s execute error", __FUNCTION__); |
| 521 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 522 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 523 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 524 | } |
| 525 | |
| 526 | static void delete_char(char str[],char target){ |
| 527 | if(str == NULL){ |
| 528 | return; |
| 529 | } |
| 530 | int i,j; |
| 531 | for(i=j=0;str[i]!='\0';i++){ |
| 532 | if(str[i]!=target){ |
| 533 | str[j++]=str[i]; |
| 534 | } |
| 535 | } |
| 536 | str[j]='\0'; |
| 537 | } |
| 538 | |
| 539 | static int parse_param(char *cmd, char **argv, char buf[]){ |
| 540 | if(cmd == NULL || argv == NULL || buf == NULL){ |
| ll | 1651f34 | 2022-06-06 10:13:48 +0800 | [diff] [blame] | 541 | return -1; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 542 | } |
| 543 | if(strstr(cmd,"ERROR")){ |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 544 | return 3; |
| 545 | } |
| 546 | else{ |
| 547 | int argc = 0; |
| 548 | char *token; |
| 549 | token = strtok(cmd, ","); |
| ll | e486066 | 2022-09-15 19:07:10 +0800 | [diff] [blame] | 550 | if(token == NULL) |
| 551 | { |
| 552 | return 9001; |
| 553 | } |
| ll | be2bdbd | 2022-06-14 02:40:33 +0000 | [diff] [blame] | 554 | if(strstr(token, "CNUM")) |
| 555 | { |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 556 | char *string; |
| 557 | while (token != NULL) |
| ll | be2bdbd | 2022-06-14 02:40:33 +0000 | [diff] [blame] | 558 | { |
| 559 | if(argc == 5) |
| 560 | { |
| 561 | if(NULL == argv[1]) |
| 562 | { |
| 563 | return 9002; |
| 564 | } |
| 565 | int lengh = strlen(argv[1]); |
| 566 | memcpy(buf, argv[1], lengh); |
| 567 | delete_char(buf, '"'); |
| 568 | RLOGD("too many phone number return\n"); |
| 569 | return 0; |
| 570 | } |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 571 | string = token; |
| 572 | argv[argc++] = string; |
| 573 | token = strtok(NULL, ","); |
| 574 | } |
| ll | be2bdbd | 2022-06-14 02:40:33 +0000 | [diff] [blame] | 575 | if(NULL == argv[1]) |
| 576 | { |
| 577 | return 9001; |
| 578 | } |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 579 | int lengh = strlen(argv[1]); |
| 580 | memcpy(buf, argv[1], lengh); |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 581 | delete_char(buf, '"'); |
| ll | 1651f34 | 2022-06-06 10:13:48 +0800 | [diff] [blame] | 582 | return 0; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 583 | } |
| ll | be2bdbd | 2022-06-14 02:40:33 +0000 | [diff] [blame] | 584 | return 9001; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 585 | } |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 586 | } |
| 587 | |
| 588 | int lynq_query_phone_number(char buf[]){ |
| ll | 27dbe75 | 2022-08-10 00:33:52 -0700 | [diff] [blame] | 589 | if(g_lynq_sim_init_flag == 0) |
| 590 | { |
| 591 | return -1; |
| 592 | } |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 593 | Parcel p; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 594 | int res = lynq_send_common_request(&p,RIL_REQUEST_OEM_HOOK_RAW,1,default_cnt,1,"%s\n", "AT+CNUM"); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 595 | if(res != 0) |
| 596 | { |
| 597 | RLOGD("function %s execute error", __FUNCTION__); |
| 598 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 599 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 600 | int num = -1; |
| 601 | p.readInt32(&num); |
| 602 | char test[128] = {0}; |
| 603 | char *argv[5] = {0}; |
| 604 | if(num != -1) |
| 605 | { |
| 606 | p.read(test, num); |
| 607 | num = parse_param(test, argv, buf); |
| 608 | return num; |
| 609 | } |
| 610 | return res; |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 611 | } |
| rjw | 5d2a50e | 2022-02-28 15:01:49 +0800 | [diff] [blame] | 612 | |
| q.huang | be2d693 | 2022-10-19 16:39:29 +0800 | [diff] [blame] | 613 | int lynq_get_imei(char buf[]) |
| 614 | { |
| 615 | if(g_lynq_sim_init_flag == 0) |
| 616 | { |
| 617 | return -1; |
| 618 | } |
| q.huang | be2d693 | 2022-10-19 16:39:29 +0800 | [diff] [blame] | 619 | Parcel p; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 620 | int res = lynq_send_common_request(&p,RIL_REQUEST_DEVICE_IDENTITY,0,default_cnt,1,""); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 621 | if(res != 0) |
| q.huang | be2d693 | 2022-10-19 16:39:29 +0800 | [diff] [blame] | 622 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 623 | RLOGD("function %s execute error", __FUNCTION__); |
| 624 | return res; |
| q.huang | be2d693 | 2022-10-19 16:39:29 +0800 | [diff] [blame] | 625 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 626 | int num = 0; |
| 627 | p.readInt32(&num); |
| 628 | char * test = lynqStrdupReadString(p); |
| 629 | memcpy(buf, test, strlen(test)); |
| 630 | free(test); |
| 631 | return res; |
| q.huang | be2d693 | 2022-10-19 16:39:29 +0800 | [diff] [blame] | 632 | } |
| 633 | |
| q.huang | 2a28279 | 2022-10-12 11:39:36 +0800 | [diff] [blame] | 634 | int lynq_get_imei_and_sv(char imei[],char sv[]) |
| q.huang | d3b254d | 2022-10-19 16:39:29 +0800 | [diff] [blame] | 635 | { |
| 636 | if(g_lynq_sim_init_flag == 0) |
| 637 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 638 | return -1; |
| q.huang | d3b254d | 2022-10-19 16:39:29 +0800 | [diff] [blame] | 639 | } |
| 640 | Parcel p; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 641 | int res = lynq_send_common_request(&p,RIL_REQUEST_DEVICE_IDENTITY,0,default_cnt,1,""); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 642 | if(res != 0) |
| q.huang | d3b254d | 2022-10-19 16:39:29 +0800 | [diff] [blame] | 643 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 644 | RLOGD("function %s execute error", __FUNCTION__); |
| 645 | return res; |
| 646 | } |
| 647 | int num = 0; |
| 648 | p.readInt32(&num); |
| 649 | if(num<2) |
| 650 | { |
| 651 | RLOGD("%s num %d error, should greater than 1",__func__,num); |
| 652 | return -1; |
| 653 | } |
| 654 | char *resp[2]={NULL,NULL}; |
| 655 | int i; |
| 656 | for(i=0;i<2;i++) |
| 657 | { |
| 658 | resp[i]= lynqStrdupReadString(p); |
| 659 | if(resp[i]==NULL) |
| 660 | { |
| 661 | break; |
| q.huang | d3b254d | 2022-10-19 16:39:29 +0800 | [diff] [blame] | 662 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 663 | } |
| 664 | if(i==2){ |
| 665 | memcpy(imei, resp[0], strlen(resp[0])+1); |
| 666 | memcpy(sv, resp[1], strlen(resp[1])+1); |
| 667 | } |
| 668 | else |
| 669 | { |
| 670 | RLOGD("%s resp[%d] is null",__func__,i); |
| 671 | } |
| 672 | for(i=0;i<2;i++) |
| 673 | { |
| 674 | if(resp[i]!=NULL) |
| 675 | { |
| 676 | free(resp[i]); |
| 677 | } |
| 678 | } |
| 679 | return i==2? 0:-1; |
| 680 | |
| q.huang | d3b254d | 2022-10-19 16:39:29 +0800 | [diff] [blame] | 681 | } |
| 682 | |
| rjw | 5d2a50e | 2022-02-28 15:01:49 +0800 | [diff] [blame] | 683 | static int judge(int slot){ |
| 684 | switch(slot){ |
| 685 | case 0: |
| 686 | return -1; |
| 687 | case 1: |
| 688 | return -1; |
| 689 | } |
| 690 | return 0; |
| 691 | } |
| 692 | |
| lh | ee0d3b3 | 2024-04-25 03:54:48 -0700 | [diff] [blame] | 693 | #ifdef MODE_DSDS |
| 694 | int lynq_set_default_sim(const int slot) |
| 695 | { |
| 696 | if(g_lynq_sim_init_flag == 0) |
| 697 | { |
| 698 | RLOGE("can`t init SIM module"); |
| 699 | return -1; |
| 700 | } |
| 701 | if(!judge(slot)) |
| 702 | { |
| 703 | RLOGD("is not 0 or 1"); |
| 704 | return -1; |
| 705 | } |
| 706 | int send_num = 0; |
| 707 | lynq_client_t client_t; |
| 708 | client_t.request = LYNQ_REQUEST_SET_DEFAULT_SIM_ALL; |
| 709 | client_t.paramLen = 1; |
| 710 | client_t.uToken = Global_uToken; |
| 711 | sprintf(client_t.param, "%d\n", slot); |
| 712 | pthread_mutex_lock(&g_lynq_sim_sendto_mutex); |
| 713 | send_num = sendto(sock_fd, &client_t, sizeof(client_t), 0, (struct sockaddr *)&addr_serv, len_addr_serv); |
| 714 | if(send_num < 0) |
| 715 | { |
| 716 | RLOGD("function %s sendto error:", __FUNCTION__); |
| xy.he | af38565 | 2024-09-12 09:38:39 +0800 | [diff] [blame^] | 717 | pthread_mutex_unlock(&g_lynq_sim_sendto_mutex); |
| lh | ee0d3b3 | 2024-04-25 03:54:48 -0700 | [diff] [blame] | 718 | return send_num; |
| 719 | } |
| 720 | |
| 721 | if(waitAllowDataSignal(SIM_ALLOW_DATA_TIMEOUT) == ETIMEDOUT) |
| 722 | { |
| 723 | LYERRLOG("timeout:wait allow data fail!!!"); |
| xy.he | af38565 | 2024-09-12 09:38:39 +0800 | [diff] [blame^] | 724 | pthread_mutex_unlock(&g_lynq_sim_sendto_mutex); |
| lh | ee0d3b3 | 2024-04-25 03:54:48 -0700 | [diff] [blame] | 725 | return LYNQ_E_TIME_OUT; |
| 726 | } |
| 727 | pthread_mutex_unlock(&g_lynq_sim_sendto_mutex); |
| 728 | LYERRLOG("sim allow data value %d",s_sim_allow_data_value); |
| 729 | return s_sim_allow_data_value; |
| 730 | } |
| xy.he | 6930788 | 2024-04-26 18:14:53 +0800 | [diff] [blame] | 731 | |
| 732 | |
| 733 | int lynq_set_default_sim_except_data(const int slot) |
| 734 | { |
| 735 | RLOGD("Enter %s",__FUNCTION__); |
| 736 | |
| 737 | if(g_lynq_sim_init_flag == 0) |
| 738 | { |
| 739 | return -1; |
| 740 | } |
| 741 | |
| 742 | RLOGD("Slot is %d",slot); |
| 743 | |
| 744 | if(!judge(slot)) |
| 745 | { |
| 746 | RLOGD("is not 0 or 1"); |
| 747 | return -1; |
| 748 | } |
| 749 | |
| 750 | int send_num = 0; |
| 751 | Parcel p; |
| 752 | RLOGD( |
| 753 | "send LYNQ_REQUEST_SET_DEFAULT_SIM_ALL_EXCEPT_DATA"); |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 754 | int res = lynq_send_common_request(&p,LYNQ_REQUEST_SET_DEFAULT_SIM_ALL_EXCEPT_DATA,1,default_cnt,1,"%d",slot); |
| xy.he | 6930788 | 2024-04-26 18:14:53 +0800 | [diff] [blame] | 755 | if(res != 0) |
| 756 | { |
| 757 | RLOGD("function %s execute error", __FUNCTION__); |
| 758 | return res; |
| 759 | } |
| 760 | |
| 761 | return 0; |
| 762 | } |
| 763 | |
| 764 | |
| 765 | |
| 766 | int lynq_get_default_sim_all(int *bit_slot) |
| 767 | { |
| 768 | RLOGD("Enter %s",__FUNCTION__); |
| 769 | |
| 770 | int sim_except_data = 0; |
| 771 | int sim_data = 0; |
| 772 | |
| 773 | if(g_lynq_sim_init_flag == 0) |
| 774 | { |
| 775 | return -1; |
| 776 | } |
| 777 | |
| 778 | int send_num = 0; |
| 779 | Parcel p; |
| 780 | |
| 781 | RLOGD( |
| 782 | "send LYNQ_REQUEST_GET_DEFAULT_SIM_ALL"); |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 783 | int res = lynq_send_common_request(&p,LYNQ_REQUEST_GET_DEFAULT_SIM_ALL,0,default_cnt,1,""); |
| xy.he | 6930788 | 2024-04-26 18:14:53 +0800 | [diff] [blame] | 784 | if(res != 0) |
| 785 | { |
| 786 | RLOGD("function %s execute error", __FUNCTION__); |
| 787 | return res; |
| 788 | } |
| 789 | |
| 790 | p.readInt32(bit_slot); |
| 791 | return 0; |
| 792 | } |
| 793 | |
| lh | ee0d3b3 | 2024-04-25 03:54:48 -0700 | [diff] [blame] | 794 | #endif |
| 795 | |
| rjw | 5d2a50e | 2022-02-28 15:01:49 +0800 | [diff] [blame] | 796 | int lynq_switch_card(int slot){ |
| ll | 27dbe75 | 2022-08-10 00:33:52 -0700 | [diff] [blame] | 797 | if(g_lynq_sim_init_flag == 0) |
| 798 | { |
| 799 | return -1; |
| 800 | } |
| rjw | 5d2a50e | 2022-02-28 15:01:49 +0800 | [diff] [blame] | 801 | if(!judge(slot)) |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 802 | return -1; |
| rjw | 5d2a50e | 2022-02-28 15:01:49 +0800 | [diff] [blame] | 803 | int send_num = 0; |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 804 | lynq_client_t client_t; |
| rjw | 5d2a50e | 2022-02-28 15:01:49 +0800 | [diff] [blame] | 805 | client_t.request = LYNQ_REQUEST_SET_DEFAULT_SIM_ALL; |
| 806 | client_t.paramLen = 1; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 807 | client_t.uToken = get_utoken(); |
| rjw | 5d2a50e | 2022-02-28 15:01:49 +0800 | [diff] [blame] | 808 | sprintf(client_t.param, "%d\n", slot); |
| ll | ab0f3e1 | 2022-07-20 11:59:51 +0000 | [diff] [blame] | 809 | pthread_mutex_lock(&g_lynq_sim_sendto_mutex); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 810 | send_num = sendto(sock_fd, &client_t, sizeof(client_t), 0, (struct sockaddr *)&addr_serv, len_addr_serv); //because ril of id = -1 |
| rjw | 5d2a50e | 2022-02-28 15:01:49 +0800 | [diff] [blame] | 811 | if(send_num < 0) |
| 812 | { |
| ll | 88f0078 | 2022-10-04 10:16:28 +0800 | [diff] [blame] | 813 | RLOGD("function %s sendto error:", __FUNCTION__); |
| rjw | 5d2a50e | 2022-02-28 15:01:49 +0800 | [diff] [blame] | 814 | return send_num; |
| 815 | } |
| ll | ab0f3e1 | 2022-07-20 11:59:51 +0000 | [diff] [blame] | 816 | pthread_mutex_unlock(&g_lynq_sim_sendto_mutex); |
| rjw | 5d2a50e | 2022-02-28 15:01:49 +0800 | [diff] [blame] | 817 | return 0; |
| 818 | } |
| jb.qi | 9644934 | 2022-09-19 22:14:41 -0700 | [diff] [blame] | 819 | /**@breif change screen state |
| 820 | *param num type: [IN] screen_state,0:close,1:open |
| 821 | *param ret type: [OUT] result,0:success,other:fail |
| 822 | *return int |
| 823 | */ |
| ll | 887a017 | 2022-03-09 03:13:31 +0000 | [diff] [blame] | 824 | int lynq_screen(int num){ |
| ll | 27dbe75 | 2022-08-10 00:33:52 -0700 | [diff] [blame] | 825 | if(g_lynq_sim_init_flag == 0) |
| 826 | { |
| 827 | return -1; |
| 828 | } |
| ll | 887a017 | 2022-03-09 03:13:31 +0000 | [diff] [blame] | 829 | if(!judge(num)) |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 830 | return -1; |
| 831 | Parcel p; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 832 | int res = lynq_send_common_request(&p,RIL_REQUEST_SCREEN_STATE,1,default_cnt,2,"%d\n",num); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 833 | if(res != 0) |
| ll | 887a017 | 2022-03-09 03:13:31 +0000 | [diff] [blame] | 834 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 835 | RLOGD("function %s execute error", __FUNCTION__); |
| 836 | return res; |
| ll | 887a017 | 2022-03-09 03:13:31 +0000 | [diff] [blame] | 837 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 838 | return res; |
| ll | 887a017 | 2022-03-09 03:13:31 +0000 | [diff] [blame] | 839 | } |
| ll | ba425bd | 2022-03-17 02:23:00 +0000 | [diff] [blame] | 840 | |
| ll | 71a113b | 2022-10-21 18:07:25 +0800 | [diff] [blame] | 841 | /**@breif change screen state |
| 842 | *param num type: [IN] screen_state,0:close,1:open |
| 843 | *param ret type: [OUT] result,0:success,other:fail |
| 844 | *return int |
| 845 | */ |
| 846 | int lynq_factory_radio_state(int num){ |
| 847 | if(g_lynq_sim_init_flag == 0) |
| 848 | { |
| 849 | return -1; |
| 850 | } |
| ll | 71a113b | 2022-10-21 18:07:25 +0800 | [diff] [blame] | 851 | if(!judge(num)) |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 852 | return -1; |
| 853 | Parcel p; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 854 | int res = lynq_send_common_request(&p,RIL_REQUEST_RADIO_POWER,1,default_cnt,2,"%d\n",num); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 855 | if(res != 0) |
| ll | 71a113b | 2022-10-21 18:07:25 +0800 | [diff] [blame] | 856 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 857 | RLOGD("function %s execute error", __FUNCTION__); |
| 858 | return res; |
| ll | 71a113b | 2022-10-21 18:07:25 +0800 | [diff] [blame] | 859 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 860 | return res; |
| ll | 71a113b | 2022-10-21 18:07:25 +0800 | [diff] [blame] | 861 | } |
| 862 | |
| ll | ba425bd | 2022-03-17 02:23:00 +0000 | [diff] [blame] | 863 | /** |
| 864 | * @brief Check whether the input is valid for lynq_req_sim_io api |
| 865 | * @param list type: [IN] list[0]:one of the commands listed for TS 27.007 +CRSM.(command) |
| 866 | * type: [IN] list[1]:EF id(fileid) |
| 867 | * type: [IN] list[2]:offset(p1) |
| 868 | * type: [IN] list[3]:offset(p2) |
| 869 | * type: [IN] list[4]:response len,sometimes needn't care(p3) |
| 870 | * @param path type: [IN] "pathid" from TS 27.007 +CRSM command. |
| 871 | type: [IN] Path is in hex asciii format eg "7f205f70" |
| 872 | type: [IN] Path must always be provided. |
| 873 | * @param data type: [IN] May be NULL |
| 874 | * @param pin2 type: [IN] May be NULL |
| 875 | * @param aidPtr type: [IN] AID value, See ETSI 102.221 8.1 and 101.220 4, NULL if no value. |
| 876 | * @param sw type: [OUT] |
| 877 | * @param simResponse type: [OUT] response |
| 878 | * @return int |
| 879 | */ |
| 880 | static int judge_illegal(int list[5], char *path, char *data, char *pin2, char *aidPtr, int sw[2], char *simResponse) |
| 881 | { |
| ll | ba425bd | 2022-03-17 02:23:00 +0000 | [diff] [blame] | 882 | if(list == NULL) |
| 883 | { |
| 884 | return -1; |
| 885 | } |
| 886 | if(path == NULL) |
| 887 | { |
| 888 | return -1; |
| 889 | } |
| 890 | if(sw == NULL){ |
| 891 | return -1; |
| 892 | } |
| 893 | if(simResponse == NULL){ |
| 894 | return -1; |
| 895 | } |
| 896 | if(data == NULL) |
| 897 | { |
| 898 | memcpy(data_buf, "null", 4); |
| 899 | } |
| 900 | else |
| 901 | { |
| 902 | bzero(data_buf,32); |
| 903 | memcpy(data_buf, data, strlen(data)); |
| 904 | } |
| 905 | if(pin2 == NULL) |
| 906 | { |
| 907 | memcpy(pin2_buf, "null", 4); |
| 908 | } |
| 909 | else |
| 910 | { |
| 911 | bzero(pin2_buf,32); |
| 912 | memcpy(pin2_buf, data, strlen(data)); |
| 913 | } |
| 914 | if(aidPtr == NULL) |
| 915 | { |
| 916 | memcpy(aidPtr_buf, "null", 4); |
| 917 | } |
| 918 | else |
| 919 | { |
| 920 | bzero(aidPtr_buf,32); |
| 921 | memcpy(aidPtr_buf, data, strlen(data)); |
| 922 | } |
| 923 | return 0; |
| 924 | } |
| 925 | |
| 926 | int lynq_req_sim_io(int list[5], char *path, char *data, char *pin2, char *aidPtr, int sw[2], char *simResponse) |
| ll | 27dbe75 | 2022-08-10 00:33:52 -0700 | [diff] [blame] | 927 | { |
| 928 | if(g_lynq_sim_init_flag == 0) |
| 929 | { |
| 930 | return -1; |
| 931 | } |
| ll | ba425bd | 2022-03-17 02:23:00 +0000 | [diff] [blame] | 932 | if(judge_illegal(list, path, data, pin2, aidPtr, sw, simResponse)) |
| 933 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 934 | return -1; |
| ll | ba425bd | 2022-03-17 02:23:00 +0000 | [diff] [blame] | 935 | } |
| 936 | Parcel p; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 937 | int res = lynq_send_common_request(&p,RIL_REQUEST_SIM_IO,9,default_cnt,1,"%d %d %s %d %d %d %s %s %s\n", list[0], list[1], path, list[2], list[3], list[4], data_buf, pin2_buf, aidPtr_buf); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 938 | if(res != 0) |
| ll | b15599d | 2022-04-01 07:50:08 +0000 | [diff] [blame] | 939 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 940 | RLOGD("function %s execute error", __FUNCTION__); |
| 941 | return res; |
| ll | ba425bd | 2022-03-17 02:23:00 +0000 | [diff] [blame] | 942 | } |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 943 | p.readInt32(&sw[0]); |
| 944 | p.readInt32(&sw[1]); |
| 945 | char * test = lynqStrdupReadString(p); |
| 946 | memcpy(simResponse, test, strlen(test)); |
| 947 | free(test); |
| 948 | return res; |
| ll | ba425bd | 2022-03-17 02:23:00 +0000 | [diff] [blame] | 949 | } |
| ll | b15599d | 2022-04-01 07:50:08 +0000 | [diff] [blame] | 950 | |
| ll | 88f0078 | 2022-10-04 10:16:28 +0800 | [diff] [blame] | 951 | static void wait_reset_mipc_response(int *response) |
| 952 | { |
| ll | 74a73b7 | 2022-10-17 10:30:58 +0800 | [diff] [blame] | 953 | usleep(500*1000); |
| ll | 88f0078 | 2022-10-04 10:16:28 +0800 | [diff] [blame] | 954 | int outfd = open("/data/tp",O_RDONLY); |
| 955 | if(outfd == -1){ |
| 956 | RLOGD("open error"); |
| 957 | return; |
| 958 | } |
| 959 | char rst[1024]; |
| 960 | int s; |
| 961 | s = read(outfd,rst,sizeof(rst)); |
| 962 | sscanf(rst,"%d",response); |
| 963 | usleep(1); |
| 964 | close(outfd); |
| 965 | return; |
| 966 | } |
| 967 | |
| 968 | int lynq_reset_modem(void) |
| 969 | { |
| 970 | if(g_lynq_sim_init_flag == 0) |
| 971 | { |
| 972 | return -1; |
| 973 | } |
| 974 | int ret = -1; |
| 975 | int send_num = 0; |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 976 | lynq_client_t client_t; |
| ll | 88f0078 | 2022-10-04 10:16:28 +0800 | [diff] [blame] | 977 | client_t.request = RIL_REQUEST_OEM_HOOK_RAW; |
| 978 | client_t.paramLen = 1; |
| xy.he | decca82 | 2024-09-03 13:26:29 +0800 | [diff] [blame] | 979 | client_t.uToken = get_utoken(); |
| ll | 88f0078 | 2022-10-04 10:16:28 +0800 | [diff] [blame] | 980 | sprintf(client_t.param, "%s\n", "AT+LRSTMD"); |
| 981 | pthread_mutex_lock(&g_lynq_sim_sendto_mutex); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 982 | send_num = sendto(sock_fd, &client_t, sizeof(client_t), 0, (struct sockaddr *)&addr_serv, len_addr_serv);//because response not by ril callback |
| ll | 88f0078 | 2022-10-04 10:16:28 +0800 | [diff] [blame] | 983 | if(send_num < 0) |
| 984 | { |
| 985 | RLOGD("function %s sendto error:", __FUNCTION__); |
| 986 | pthread_mutex_unlock(&g_lynq_sim_sendto_mutex); |
| 987 | return ret; |
| 988 | } |
| 989 | wait_reset_mipc_response(&ret); |
| 990 | pthread_mutex_unlock(&g_lynq_sim_sendto_mutex); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 991 | RLOGD("function %s ret %d",__FUNCTION__, ret); |
| ll | 88f0078 | 2022-10-04 10:16:28 +0800 | [diff] [blame] | 992 | return ret; |
| 993 | } |
| 994 | |
| ll | b15599d | 2022-04-01 07:50:08 +0000 | [diff] [blame] | 995 | /** |
| 996 | * @brief handle shutdown buf |
| 997 | * @param options type: [IN]My Param doc |
| 998 | * @param time type: [IN]My Param doc |
| 999 | * @param message type: [IN]My Param doc |
| 1000 | */ |
| 1001 | static void handle_shutdown_buf(char options[], char time[], char message[]) |
| 1002 | { |
| 1003 | if(NULL == options) |
| 1004 | { |
| 1005 | bzero(options_buf, 32); |
| 1006 | memcpy(options_buf," ", 1); |
| 1007 | } |
| 1008 | else |
| 1009 | { |
| 1010 | memcpy(options_buf,options, strlen(options)); |
| 1011 | } |
| 1012 | if(NULL == time) |
| 1013 | { |
| 1014 | bzero(time_buf, 32); |
| 1015 | memcpy(time_buf," ", 1); |
| 1016 | } |
| 1017 | else |
| 1018 | { |
| 1019 | memcpy(time_buf, time, strlen(time)); |
| 1020 | } |
| 1021 | if(NULL == message) |
| 1022 | { |
| 1023 | bzero(message_buf, 32); |
| 1024 | memcpy(message_buf," ", 1); |
| 1025 | } |
| 1026 | else |
| 1027 | { |
| 1028 | memcpy(message_buf, message, strlen(message)); |
| 1029 | } |
| 1030 | } |
| 1031 | |
| 1032 | int lynq_shutdown(char options[], char time[], char message[]) |
| 1033 | { |
| 1034 | char cmd[128] = {0}; |
| 1035 | handle_shutdown_buf(options, time, message); |
| 1036 | sprintf(cmd, "%s %s %s %s", "shutdown", options_buf, time_buf, message_buf); |
| 1037 | system(cmd); |
| 1038 | return 0; |
| 1039 | } |
| 1040 | |
| 1041 | int lynq_get_version(char buf[]) |
| 1042 | { |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 1043 | FILE *fp; |
| ll | b15599d | 2022-04-01 07:50:08 +0000 | [diff] [blame] | 1044 | char buffer[128]; |
| 1045 | sprintf(buffer, "%s", "uci get lynq_uci_ro.lynq_version.LYNQ_SW_VERSION"); |
| 1046 | fp = popen(buffer, "r"); |
| you.chen | 24d54af | 2024-01-02 12:26:57 +0800 | [diff] [blame] | 1047 | if(NULL == fp) |
| 1048 | { |
| 1049 | RLOGE("popen failed !"); |
| 1050 | return -1; |
| 1051 | } |
| 1052 | if(NULL != fgets(buffer, sizeof(buffer), fp)) |
| 1053 | { |
| 1054 | if('\n' == buffer[strlen(buffer) - 1]) |
| 1055 | { |
| 1056 | buffer[strlen(buffer) - 1] = '\0'; |
| 1057 | } |
| 1058 | } |
| 1059 | else |
| 1060 | { |
| 1061 | RLOGE("fgets failed !"); |
| 1062 | pclose(fp); |
| 1063 | return -1; |
| 1064 | } |
| ll | b15599d | 2022-04-01 07:50:08 +0000 | [diff] [blame] | 1065 | memcpy(buf, buffer, strlen(buffer)); |
| 1066 | buf[strlen(buffer)] = '\0'; |
| 1067 | pclose(fp); |
| 1068 | return 0; |
| 1069 | } |
| ll | e1d5d7c | 2022-01-18 12:34:30 +0000 | [diff] [blame] | 1070 | |
| lh | ee0d3b3 | 2024-04-25 03:54:48 -0700 | [diff] [blame] | 1071 | void urc_msg_process(Parcel *p) |
| 1072 | { |
| 1073 | int resp_type; |
| 1074 | int urcid; |
| 1075 | int slot_id; |
| 1076 | int error_code; |
| 1077 | |
| 1078 | int size=p->dataSize(); |
| 1079 | p->readInt32(&resp_type); |
| 1080 | p->readInt32(&urcid); |
| 1081 | p->readInt32(&slot_id); |
| 1082 | LYINFLOG("%s urc id = %d, slot_id = %d, size is %d",__func__, urcid,slot_id,size); |
| 1083 | switch (urcid) |
| 1084 | { |
| 1085 | case LYNQ_URC_ALLOW_DATA://new sms received |
| 1086 | { |
| 1087 | LYINFLOG("**************:resp_type=%d,urcid=%d,slot_id=%d",resp_type,urcid,slot_id); |
| 1088 | p->readInt32(&error_code); |
| 1089 | sendAllowDataSignal(error_code); |
| 1090 | break; |
| 1091 | } |
| 1092 | default: |
| 1093 | break; |
| 1094 | } |
| 1095 | } |
| 1096 | |