static gboolean parse_gsm_tpdu(GIsiSubBlockIter *parent, struct sms_addr *add, struct sms_common *com) { GIsiSubBlockIter iter; for (g_isi_sb_subiter_init(parent, &iter, 2); g_isi_sb_iter_is_valid(&iter); g_isi_sb_iter_next(&iter)) { switch (g_isi_sb_iter_get_id(&iter)) { case SMS_ADDRESS: if (!parse_sms_address(&iter, 2, add)) return FALSE; if (add->type != SMS_GSM_0411_ADDRESS) return FALSE; break; case SMS_COMMON_DATA: if (!parse_sms_tpdu(&iter, 2, com)) return FALSE; break; } } return TRUE; }
static void registration_resp_cb(const GIsiMessage *msg, void *data) { struct isi_cb_data *cbd = data; ofono_call_forwarding_set_cb_t cb = cbd->cb; GIsiSubBlockIter iter; uint8_t status; if (!check_resp(msg, SS_SERVICE_COMPLETED_RESP, SS_REGISTRATION)) goto error; for (g_isi_sb_iter_init(&iter, msg, 6); g_isi_sb_iter_is_valid(&iter); g_isi_sb_iter_next(&iter)) { if (g_isi_sb_iter_get_id(&iter) != SS_GSM_FORWARDING_INFO) continue; if (!decode_gsm_forwarding_info(&iter, &status, NULL, NULL, NULL)) goto error; if (status & (SS_GSM_ACTIVE | SS_GSM_REGISTERED)) { CALLBACK_WITH_SUCCESS(cb, cbd->data); return; } } error: CALLBACK_WITH_FAILURE(cb, cbd->data); }
static void bearer_query_resp_cb(const GIsiMessage *msg, void *data) { struct isi_cb_data *cbd = data; ofono_sms_bearer_query_cb_t cb = cbd->cb; GIsiSubBlockIter iter; uint8_t sb, cs, ps; if (!check_sms(msg, SMS_SETTINGS_READ_RESP, SMS_OK)) goto error; if (!g_isi_msg_data_get_byte(msg, 1, &sb)) goto error; for (g_isi_sb_iter_init_full(&iter, msg, 2, TRUE, sb); g_isi_sb_iter_is_valid(&iter); g_isi_sb_iter_next(&iter)) { if (g_isi_sb_iter_get_id(&iter) != SMS_SB_ROUTE_INFO) continue; if (!g_isi_msg_data_get_byte(msg, 5, &cs)) goto error; if (!g_isi_msg_data_get_byte(msg, 6, &ps)) goto error; CALLBACK_WITH_SUCCESS(cb, cs_ps_pref_to_bearer(cs, ps), cbd->data); return; } error: CALLBACK_WITH_FAILURE(cb, 0, cbd->data); }
static void submit_gsm_tpdu_resp_cb(const GIsiMessage *msg, void *data) { struct isi_cb_data *cbd = data; ofono_sms_submit_cb_t cb = cbd->cb; struct sms_report *report; size_t len = sizeof(struct sms_report); GIsiSubBlockIter iter; if (!check_sms(msg, SMS_MESSAGE_SEND_RESP, -1)) goto error; for (g_isi_sb_iter_init(&iter, msg, 2); g_isi_sb_iter_is_valid(&iter); g_isi_sb_iter_next(&iter)) { if (g_isi_sb_iter_get_id(&iter) != SMS_GSM_REPORT) continue; if (!g_isi_sb_iter_get_struct(&iter, (void **) &report, len, 2)) goto error; if (report->type == SMS_CAUSE_TYPE_COMMON && report->cause == SMS_OK) { CALLBACK_WITH_SUCCESS(cb, report->ref, cbd->data); return; } submit_failure_debug(report); } error: CALLBACK_WITH_FAILURE(cb, -1, cbd->data); }
static void received_msg_ind_cb(const GIsiMessage *msg, void *data) { struct ofono_sms *sms = data; struct sms_data *sd = ofono_sms_get_data(sms); struct sms_common tpdu; struct sms_addr addr; GIsiSubBlockIter iter; uint8_t pdu[176]; uint8_t sbcount; DBG(""); if (g_isi_msg_id(msg) != SMS_RECEIVED_MSG_IND) return; if (!g_isi_msg_data_get_byte(msg, 1, &sbcount)) return; for (g_isi_sb_iter_init_full(&iter, msg, 2, TRUE, sbcount); g_isi_sb_iter_is_valid(&iter); g_isi_sb_iter_next(&iter)) { switch (g_isi_sb_iter_get_id(&iter)) { case SMS_ADDRESS: if (!parse_sms_address(&iter, 4, &addr)) return; if (addr.type != SMS_SMSC_ADDRESS) return; break; case SMS_SB_TPDU: if (!parse_sms_tpdu(&iter, 4, &tpdu)) return; break; } } if (tpdu.data == NULL || addr.data == NULL || tpdu.len + addr.len > sizeof(pdu)) return; memcpy(pdu, addr.data, addr.len); memcpy(pdu + addr.len, tpdu.data, tpdu.len); /* 23.040 9.2.3.1 */ if ((tpdu.data[0] & 0x03) == 0x02) ofono_sms_status_notify(sms, pdu, tpdu.len + addr.len, tpdu.len); else ofono_sms_deliver_notify(sms, pdu, tpdu.len + addr.len, tpdu.len); send_deliver_report(sd->client, TRUE, NULL, NULL); }
static void u8500_info_resp_cb(const GIsiMessage *msg, void *data) { struct isi_cb_data *cbd = data; ofono_devinfo_query_cb_t cb = cbd->cb; GIsiSubBlockIter iter; uint8_t msgid; uint8_t status; msgid = g_isi_msg_id(msg); if (msgid != INFO_SERIAL_NUMBER_READ_RESP) goto error; if (g_isi_msg_error(msg) < 0) goto error; if (!g_isi_msg_data_get_byte(msg, 0, &status)) goto error; if (status != INFO_OK) goto error; for (g_isi_sb_iter_init(&iter, msg, 2); g_isi_sb_iter_is_valid(&iter); g_isi_sb_iter_next(&iter)) { uint8_t id = g_isi_sb_iter_get_id(&iter); uint8_t chars; char *info = NULL; if (id != INFO_SB_PRODUCT_INFO_MANUFACTURER && id != INFO_SB_PRODUCT_INFO_NAME && id != INFO_SB_MCUSW_VERSION && id != INFO_SB_SN_IMEI_PLAIN && id != INFO_SB_MODEMSW_VERSION) continue; if (g_isi_sb_iter_get_len(&iter) < 5) goto error; if (!g_isi_sb_iter_get_byte(&iter, &chars, 3)) goto error; if (!g_isi_sb_iter_get_latin_tag(&iter, &info, chars, 4)) goto error; CALLBACK_WITH_SUCCESS(cb, info, cbd->data); g_free(info); return; } error: CALLBACK_WITH_FAILURE(cb, "", cbd->data); }
static gboolean decode_gsm_forwarding_info(GIsiSubBlockIter *parent, uint8_t *status, uint8_t *ton, uint8_t *noreply, char **number) { GIsiSubBlockIter iter; struct forw_info *info; size_t len = sizeof(struct forw_info); char *tag = NULL; for (g_isi_sb_subiter_init(parent, &iter, 4); g_isi_sb_iter_is_valid(&iter); g_isi_sb_iter_next(&iter)) { if (g_isi_sb_iter_get_id(&iter) != SS_GSM_FORWARDING_FEATURE) continue; if (!g_isi_sb_iter_get_struct(&iter, (void *) &info, len, 2)) return FALSE; if (info->numlen != 0) { if (!g_isi_sb_iter_get_alpha_tag(&iter, &tag, info->numlen * 2, 2 + len)) return FALSE; if (number) *number = tag; else g_free(tag); } else { if (number) *number = g_strdup(""); } if (status) *status = info->status; if (ton) *ton = info->ton; if (noreply) *noreply = info->noreply; return TRUE; } return FALSE; }
static void routing_ntf_cb(const GIsiMessage *msg, void *data) { struct ofono_sms *sms = data; struct sms_data *sd = ofono_sms_get_data(sms); struct sms_common tpdu; struct sms_addr addr; GIsiSubBlockIter iter; uint8_t pdu[176]; if (g_isi_msg_id(msg) != SMS_PP_ROUTING_NTF) return; for (g_isi_sb_iter_init(&iter, msg, 2); g_isi_sb_iter_is_valid(&iter); g_isi_sb_iter_next(&iter)) { if (g_isi_sb_iter_get_id(&iter) != SMS_GSM_TPDU) continue; if (!parse_gsm_tpdu(&iter, &addr, &tpdu)) return; } if (tpdu.data == NULL || addr.data == NULL || tpdu.len + addr.len > sizeof(pdu)) return; memcpy(pdu, addr.data, addr.len); memcpy(pdu + addr.len, tpdu.data, tpdu.len); /* 23.040 9.2.3.1 */ if ((tpdu.data[0] & 0x03) == 0x02) ofono_sms_status_notify(sms, pdu, tpdu.len + addr.len, tpdu.len); else ofono_sms_deliver_notify(sms, pdu, tpdu.len + addr.len, tpdu.len); send_gsm_deliver_report(sd->client, TRUE, NULL, NULL); }
static int decode_read_response(const unsigned char *msg, size_t len, struct ofono_phonebook *pb) { GIsiSubBlockIter iter; char *name = NULL; char *number = NULL; char *sne = NULL; char *anr = NULL; char *email = NULL; int location = -1; guint8 status = 0; if (len < 3 || msg[0] != SIM_PB_RESP_SIM_PB_READ) goto error; if (msg[1] != SIM_PB_READ) goto error; for (g_isi_sb_iter_init_full(&iter, msg, len, 3, TRUE, msg[2]); g_isi_sb_iter_is_valid(&iter); g_isi_sb_iter_next(&iter)) { switch (g_isi_sb_iter_get_id(&iter)) { case SIM_PB_ADN: { guint16 loc; guint8 namelen; guint8 numberlen; if (!g_isi_sb_iter_get_word(&iter, &loc, 4) || !g_isi_sb_iter_get_byte(&iter, &namelen, 6) || !g_isi_sb_iter_get_byte(&iter, &numberlen, 7)) goto error; if (!g_isi_sb_iter_get_alpha_tag(&iter, &name, namelen * 2, 8)) goto error; if (!g_isi_sb_iter_get_alpha_tag(&iter, &number, numberlen * 2, 8 + namelen * 2)) goto error; location = loc; break; } case SIM_PB_SNE: { guint8 snelen; if (!g_isi_sb_iter_get_byte(&iter, &snelen, 6)) goto error; if (!g_isi_sb_iter_get_alpha_tag(&iter, &sne, snelen * 2, 8)) goto error; break; } case SIM_PB_ANR: { guint8 anrlen; if (!g_isi_sb_iter_get_byte(&iter, &anrlen, 6)) goto error; if (!g_isi_sb_iter_get_alpha_tag(&iter, &anr, anrlen * 2, 8)) goto error; break; } case SIM_PB_EMAIL: { guint8 emaillen; if (!g_isi_sb_iter_get_byte(&iter, &emaillen, 6)) goto error; if (!g_isi_sb_iter_get_alpha_tag(&iter, &email, emaillen * 2, 8)) goto error; break; } case SIM_PB_STATUS: if (!g_isi_sb_iter_get_byte(&iter, &status, 4)) goto error; break; default: DBG("Skipping sub-block: %s (%zd bytes)", sim_subblock_name(g_isi_sb_iter_get_id(&iter)), g_isi_sb_iter_get_len(&iter)); break; } } if (status != SIM_SERV_OK) { DBG("Request failed: %s (0x%02X)", sim_isi_cause_name(status), status); goto error; } ofono_phonebook_entry(pb, -1, number, -1, name, -1, NULL, anr, -1, sne, email, NULL, NULL); error: g_free(name); g_free(number); g_free(sne); g_free(anr); g_free(email); return location; }
static void isi_registration(struct ofono_call_forwarding *cf, int type, int cls, const struct ofono_phone_number *number, int time, ofono_call_forwarding_set_cb_t cb, void *data) { struct forw_data *fd = ofono_call_forwarding_get_data(cf); struct isi_cb_data *cbd = isi_cb_data_new(cf, cb, data); int ss_code = forw_type_to_isi_code(type); char *ucs2 = NULL; size_t numlen = strlen(number->number); size_t sb_len = ALIGN4(6 + 2 * numlen); size_t pad_len = sb_len - (6 + 2 * numlen); uint8_t msg[7 + 6 + 28 * 2 + 3] = { SS_SERVICE_REQ, SS_REGISTRATION, SS_GSM_TELEPHONY, ss_code >> 8, ss_code & 0xFF, SS_SEND_ADDITIONAL_INFO, 1, /* Subblock count */ SS_FORWARDING, sb_len, number->type, ss_code == SS_GSM_FORW_NO_REPLY ? time : SS_UNDEFINED_TIME, numlen, 0, /* Sub address length */ /* * Followed by number in UCS-2 (no NULL termination), * zero sub address bytes, and 0 to 3 bytes of filler */ }; size_t msg_len = 7 + 6 + numlen * 2 + pad_len; if (cbd == NULL || fd == NULL || numlen > 28) goto error; DBG("forwarding type %d class %d number %s", type, cls, number->number); if (ss_code < 0) goto error; ucs2 = g_convert(number->number, numlen, "UCS-2BE", "UTF-8//TRANSLIT", NULL, NULL, NULL); if (ucs2 == NULL) goto error; memcpy(msg + 13, ucs2, numlen * 2); g_free(ucs2); if (g_isi_client_send(fd->client, msg, msg_len, registration_resp_cb, cbd, g_free)) return; error: CALLBACK_WITH_FAILURE(cb, data); g_free(cbd); } static void erasure_resp_cb(const GIsiMessage *msg, void *data) { struct isi_cb_data *cbd = data; ofono_call_forwarding_set_cb_t cb = cbd->cb; GIsiSubBlockIter iter; uint8_t status; if (!check_resp(msg, SS_SERVICE_COMPLETED_RESP, SS_ERASURE)) goto error; for (g_isi_sb_iter_init(&iter, msg, 6); g_isi_sb_iter_is_valid(&iter); g_isi_sb_iter_next(&iter)) { if (g_isi_sb_iter_get_id(&iter) != SS_GSM_FORWARDING_INFO) continue; if (!decode_gsm_forwarding_info(&iter, &status, NULL, NULL, NULL)) goto error; if (status & (SS_GSM_ACTIVE | SS_GSM_REGISTERED)) goto error; } CALLBACK_WITH_SUCCESS(cb, cbd->data); return; error: CALLBACK_WITH_FAILURE(cb, cbd->data); } static void isi_erasure(struct ofono_call_forwarding *cf, int type, int cls, ofono_call_forwarding_set_cb_t cb, void *data) { struct forw_data *fd = ofono_call_forwarding_get_data(cf); struct isi_cb_data *cbd = isi_cb_data_new(cf, cb, data); int ss_code = forw_type_to_isi_code(type); const uint8_t msg[] = { SS_SERVICE_REQ, SS_ERASURE, SS_GSM_TELEPHONY, ss_code >> 8, ss_code & 0xFF, SS_SEND_ADDITIONAL_INFO, 0, /* Subblock count */ }; DBG("forwarding type %d class %d", type, cls); if (cbd == NULL || fd == NULL || ss_code < 0) goto error; if (g_isi_client_send(fd->client, msg, sizeof(msg), erasure_resp_cb, cbd, g_free)) return; error: CALLBACK_WITH_FAILURE(cb, data); g_free(cbd); } static void query_resp_cb(const GIsiMessage *msg, void *data) { struct isi_cb_data *cbd = data; ofono_call_forwarding_query_cb_t cb = cbd->cb; GIsiSubBlockIter iter; struct ofono_call_forwarding_condition list = { .status = 0, .cls = 7, .time = 0, .phone_number = { .number[0] = '\0', .type = 0, }, }; uint8_t status; uint8_t ton; uint8_t noreply; char *number = NULL; if (!check_resp(msg, SS_SERVICE_COMPLETED_RESP, SS_INTERROGATION)) goto error; for (g_isi_sb_iter_init(&iter, msg, 6); g_isi_sb_iter_is_valid(&iter); g_isi_sb_iter_next(&iter)) { DBG("Got %s", ss_subblock_name(g_isi_sb_iter_get_id(&iter))); if (g_isi_sb_iter_get_id(&iter) != SS_GSM_FORWARDING_INFO) continue; if (!decode_gsm_forwarding_info(&iter, &status, &ton, &noreply, &number)) goto error; list.status = status & (SS_GSM_ACTIVE | SS_GSM_REGISTERED | SS_GSM_PROVISIONED); list.time = noreply; list.phone_number.type = ton | 0x80; DBG("Number <%s>", number); strncpy(list.phone_number.number, number, OFONO_MAX_PHONE_NUMBER_LENGTH); list.phone_number.number[OFONO_MAX_PHONE_NUMBER_LENGTH] = '\0'; g_free(number); DBG("forwarding query: %d, %d, %s(%d) - %d sec", list.status, list.cls, list.phone_number.number, list.phone_number.type, list.time); } CALLBACK_WITH_SUCCESS(cb, 1, &list, cbd->data); return; error: CALLBACK_WITH_FAILURE(cb, 0, NULL, cbd->data); } static void isi_query(struct ofono_call_forwarding *cf, int type, int cls, ofono_call_forwarding_query_cb_t cb, void *data) { struct forw_data *fd = ofono_call_forwarding_get_data(cf); struct isi_cb_data *cbd = isi_cb_data_new(cf, cb, data); int ss_code = forw_type_to_isi_code(type); const uint8_t msg[] = { SS_SERVICE_REQ, SS_INTERROGATION, SS_GSM_TELEPHONY, ss_code >> 8, ss_code & 0xFF, SS_SEND_ADDITIONAL_INFO, 0, /* Subblock count */ }; DBG("forwarding type %d class %d", type, cls); if (cbd == NULL || fd == NULL || cls != 7 || ss_code < 0) goto error; if (g_isi_client_send(fd->client, msg, sizeof(msg), query_resp_cb, cbd, g_free)) return; error: CALLBACK_WITH_FAILURE(cb, 0, NULL, data); g_free(cbd); } static void reachable_cb(const GIsiMessage *msg, void *data) { struct ofono_call_forwarding *cf = data; if (g_isi_msg_error(msg) < 0) { ofono_call_forwarding_remove(cf); return; } ISI_RESOURCE_DBG(msg); ofono_call_forwarding_register(cf); } static int isi_call_forwarding_probe(struct ofono_call_forwarding *cf, unsigned int vendor, void *user) { GIsiModem *modem = user; struct forw_data *fd; fd = g_try_new0(struct forw_data, 1); if (fd == NULL) return -ENOMEM; fd->client = g_isi_client_create(modem, PN_SS); if (fd->client == NULL) { g_free(fd); return -ENOMEM; } ofono_call_forwarding_set_data(cf, fd); g_isi_client_verify(fd->client, reachable_cb, cf, NULL); return 0; }