Implementation for open/close channel, list applications,
and session based file read.
---
drivers/atmodem/sim.c | 385 ++++++++++++++++++++++++++++++++++++++++++++++++++
1 file changed, 385 insertions(+)
diff --git a/drivers/atmodem/sim.c b/drivers/atmodem/sim.c
index 8665274..fb1f1f0 100644
--- a/drivers/atmodem/sim.c
+++ b/drivers/atmodem/sim.c
@@ -39,6 +39,7 @@
#include "gatresult.h"
#include "simutil.h"
#include "vendor.h"
+#include "util.h"
#include "atmodem.h"
@@ -70,6 +71,9 @@ static const char *pct_prefix[] = { "#PCT:", NULL };
static const char *pnnm_prefix[] = { "+PNNM:", NULL };
static const char *qpinc_prefix[] = { "+QPINC:", NULL };
static const char *upincnt_prefix[] = { "+UPINCNT:", NULL };
+static const char *cuad_prefix[] = { "+CUAD:", NULL };
+static const char *ccho_prefix[] = { "+CCHO:", NULL };
+static const char *crla_prefix[] = { "+CRLA:", NULL };
static const char *none_prefix[] = { NULL };
static void at_crsm_info_cb(gboolean ok, GAtResult *result, gpointer user_data)
@@ -1603,6 +1607,381 @@ done:
ofono_sim_register(sim);
}
+static void at_discover_apps_cb(gboolean ok, GAtResult *result,
+ gpointer user_data)
+{
+ struct cb_data *cbd = user_data;
+ GAtResultIter iter;
+ ofono_sim_list_apps_cb_t cb = cbd->cb;
+ struct ofono_error error;
+ const unsigned char *dataobj;
+ gint linelen;
+ unsigned char *buffer;
+ int len;
+
+ decode_at_error(&error, g_at_result_final_response(result));
+
+ if (!ok) {
+ cb(&error, NULL, 0, cbd->data);
+ return;
+ }
+
+ g_at_result_iter_init(&iter, result);
+
+ len = 0;
+ while (g_at_result_iter_next(&iter, "+CUAD:")) {
+ if (!g_at_result_iter_next_hexstring(&iter, NULL, &linelen))
+ goto error;
+
+ len += linelen;
+ }
+
+ g_at_result_iter_init(&iter, result);
+
+ buffer = g_malloc(len);
+ len = 0;
+
+ while (g_at_result_iter_next(&iter, "+CUAD:")) {
+ g_at_result_iter_next_hexstring(&iter, &dataobj, &linelen);
+ memcpy(buffer + len, dataobj, linelen);
+ len += linelen;
+ }
+
+ cb(&error, buffer, len, cbd->data);
+
+ g_free(buffer);
+ return;
+
+error:
+ CALLBACK_WITH_FAILURE(cb, NULL, 0, cbd->data);
+}
+
+static void at_discover_apps(struct ofono_sim *sim,
+ ofono_sim_list_apps_cb_t cb,
+ void *data)
+{
+ struct sim_data *sd = ofono_sim_get_data(sim);
+ struct cb_data *cbd = cb_data_new(cb, data);
+
+ if (g_at_chat_send(sd->chat, "AT+CUAD", cuad_prefix,
+ at_discover_apps_cb, cbd, g_free) > 0)
+ return;
+
+ g_free(cbd);
+
+ CALLBACK_WITH_FAILURE(cb, NULL, 0, data);
+}
+
+static void at_open_channel_cb(gboolean ok, GAtResult *result,
+ gpointer user_data)
+{
+ struct cb_data *cbd = user_data;
+ GAtResultIter iter;
+ ofono_sim_open_channel_cb_t cb = cbd->cb;
+ struct ofono_error error;
+ int session_id = -1;
+
+ decode_at_error(&error, g_at_result_final_response(result));
+
+ if (!ok)
+ goto error;
+
+ g_at_result_iter_init(&iter, result);
+
+ if (!g_at_result_iter_next(&iter, "+CCHO:"))
+ goto error;
+
+ if (!g_at_result_iter_next_number(&iter, &session_id))
+ goto error;
+
+ cb(&error, session_id, cbd->data);
+
+ return;
+
+error:
+ cb(&error, -1, cbd->data);
+}
+
+static void at_open_channel(struct ofono_sim *sim, const unsigned char *aid,
+ ofono_sim_open_channel_cb_t cb, void *data)
+{
+ struct sim_data *sd = ofono_sim_get_data(sim);
+ struct cb_data *cbd = cb_data_new(cb, data);
+ char cmd[43];
+ int ret = 0;
+
+ strcpy(cmd, "AT+CCHO=\"");
+ ret += 9;
+
+ encode_hex_own_buf(aid, 16, 0, cmd + ret);
+ ret += 32;
+
+ strcpy(cmd + ret, "\"");
+
+ if (g_at_chat_send(sd->chat, cmd, ccho_prefix, at_open_channel_cb,
+ cbd, g_free) > 0)
+ return;
+
+ g_free(cbd);
+
+ CALLBACK_WITH_FAILURE(cb, -1, data);
+}
+
+static void at_close_channel_cb(gboolean ok, GAtResult *result,
+ gpointer user_data)
+{
+ struct cb_data *cbd = user_data;
+ ofono_sim_close_channel_cb_t cb = cbd->cb;
+ struct ofono_error error;
+
+ decode_at_error(&error, g_at_result_final_response(result));
+
+ if (cb)
+ cb(&error, cbd->data);
+}
+
+static void at_close_channel(struct ofono_sim *sim, int session_id,
+ ofono_sim_close_channel_cb_t cb, void *data)
+{
+ struct sim_data *sd = ofono_sim_get_data(sim);
+ struct cb_data *cbd = cb_data_new(cb, data);
+ char cmd[15];
+
+ sprintf(cmd, "AT+CCHC=%d", session_id);
+
+ g_at_chat_send(sd->chat, cmd, NULL, at_close_channel_cb, cbd, g_free);
+}
+
+static void at_crla_read_cb(gboolean ok, GAtResult *result,
+ gpointer user_data)
+{
+ struct cb_data *cbd = user_data;
+ GAtResultIter iter;
+ ofono_sim_read_cb_t cb = cbd->cb;
+ struct ofono_error error;
+ const guint8 *response;
+ gint sw1, sw2, len;
+
+ decode_at_error(&error, g_at_result_final_response(result));
+
+ if (!ok) {
+ cb(&error, NULL, 0, cbd->data);
+ return;
+ }
+
+ g_at_result_iter_init(&iter, result);
+
+ if (!g_at_result_iter_next(&iter, "+CRLA:")) {
+ CALLBACK_WITH_FAILURE(cb, NULL, 0, cbd->data);
+ return;
+ }
+
+ g_at_result_iter_next_number(&iter, &sw1);
+ g_at_result_iter_next_number(&iter, &sw2);
+
+ if ((sw1 != 0x90 && sw1 != 0x91 && sw1 != 0x92 && sw1 != 0x9f)
||
+ (sw1 == 0x90 && sw2 != 0x00)) {
+ memset(&error, 0, sizeof(error));
+
+ error.type = OFONO_ERROR_TYPE_SIM;
+ error.error = (sw1 << 8) | sw2;
+
+ cb(&error, NULL, 0, cbd->data);
+ return;
+ }
+
+ if (!g_at_result_iter_next_hexstring(&iter, &response, &len)) {
+ CALLBACK_WITH_FAILURE(cb, NULL, 0, cbd->data);
+ return;
+ }
+
+ DBG("crla_read_cb: %02x, %02x, %d", sw1, sw2, len);
+
+ cb(&error, response, len, cbd->data);
+}
+
+static void at_session_read_binary(struct ofono_sim *sim, int session,
+ int fileid, int start, int length,
+ const unsigned char *path,
+ unsigned int path_len,
+ ofono_sim_read_cb_t cb, void *data)
+{
+ struct sim_data *sd = ofono_sim_get_data(sim);
+ struct cb_data *cbd = cb_data_new(cb, data);
+ char buf[64];
+ unsigned int len;
+
+ len = snprintf(buf, sizeof(buf), "AT+CRLA=%i,176,%i,%i,%i,%i,,",
+ session, fileid, start >> 8, start & 0xff, length);
+
+ if (path_len > 0) {
+ buf[len++] = ',';
+ buf[len++] = ',';
+ buf[len++] = '\"';
+
+ for (; path_len; path_len--)
+ len += sprintf(buf + len, "%02hhX", *path++);
+
+ buf[len++] = '\"';
+ buf[len] = '\0';
+ }
+
+ if (g_at_chat_send(sd->chat, buf, crla_prefix,
+ at_crla_read_cb, cbd, g_free) > 0)
+ return;
+
+ g_free(cbd);
+
+ CALLBACK_WITH_FAILURE(cb, NULL, 0, data);
+}
+
+static void at_session_read_record(struct ofono_sim *sim, int session_id,
+ int fileid, int record, int length,
+ const unsigned char *path,
+ unsigned int path_len,
+ ofono_sim_read_cb_t cb, void *data)
+{
+ struct sim_data *sd = ofono_sim_get_data(sim);
+ struct cb_data *cbd = cb_data_new(cb, data);
+ char buf[128];
+
+ snprintf(buf, sizeof(buf), "AT+CRLA=%i,178,%i,%i,4,%i", session_id,
+ fileid, record, length);
+
+ if (g_at_chat_send(sd->chat, buf, crla_prefix,
+ at_crla_read_cb, cbd, g_free) > 0)
+ return;
+
+ g_free(cbd);
+
+ CALLBACK_WITH_FAILURE(cb, NULL, 0, data);
+}
+
+static void at_crla_info_cb(gboolean ok, GAtResult *result, gpointer user_data)
+{
+ struct cb_data *cbd = user_data;
+ GAtResultIter iter;
+ ofono_sim_file_info_cb_t cb = cbd->cb;
+ struct ofono_error error;
+ const guint8 *response;
+ gint sw1, sw2, len;
+ int flen, rlen;
+ int str;
+ unsigned char access[3];
+ unsigned char file_status;
+
+ decode_at_error(&error, g_at_result_final_response(result));
+
+ if (!ok) {
+ cb(&error, -1, -1, -1, NULL, EF_STATUS_INVALIDATED, cbd->data);
+ return;
+ }
+
+ g_at_result_iter_init(&iter, result);
+
+ if (!g_at_result_iter_next(&iter, "+CRLA:"))
+ goto error;
+
+ g_at_result_iter_next_number(&iter, &sw1);
+ g_at_result_iter_next_number(&iter, &sw2);
+
+ if (!g_at_result_iter_next_hexstring(&iter, &response, &len) ||
+ (sw1 != 0x90 && sw1 != 0x91 && sw1 != 0x92) ||
+ (sw1 == 0x90 && sw2 != 0x00)) {
+ memset(&error, 0, sizeof(error));
+
+ error.type = OFONO_ERROR_TYPE_SIM;
+ error.error = (sw1 << 8) | sw2;
+
+ cb(&error, -1, -1, -1, NULL, EF_STATUS_INVALIDATED, cbd->data);
+ return;
+ }
+
+ DBG("crla_info_cb: %02x, %02x, %i", sw1, sw2, len);
+
+ if (response[0] == 0x62) {
+ ok = sim_parse_3g_get_response(response, len, &flen, &rlen,
+ &str, access, NULL);
+
+ file_status = EF_STATUS_VALID;
+ } else
+ ok = sim_parse_2g_get_response(response, len, &flen, &rlen,
+ &str, access, &file_status);
+
+ if (!ok)
+ goto error;
+
+ cb(&error, flen, str, rlen, access, file_status, cbd->data);
+
+ return;
+
+error:
+ CALLBACK_WITH_FAILURE(cb, -1, -1, -1, NULL,
+ EF_STATUS_INVALIDATED, cbd->data);
+}
+
+static void at_session_read_info(struct ofono_sim *sim, int session_id,
+ int fileid, const unsigned char *path,
+ unsigned int path_len,
+ ofono_sim_file_info_cb_t cb, void *data)
+{
+ struct sim_data *sd = ofono_sim_get_data(sim);
+ struct cb_data *cbd;
+ char buf[128];
+ unsigned int len;
+
+ if (sd->vendor == OFONO_VENDOR_OPTION_HSO) {
+ unsigned char access[3] = { 0x00, 0x00, 0x00 };
+
+ if (fileid == SIM_EFAD_FILEID) {
+ CALLBACK_WITH_SUCCESS(cb, 4, 0, 0, access,
+ EF_STATUS_VALID, data);
+ return;
+ }
+ }
+
+ cbd = cb_data_new(cb, data);
+
+ len = snprintf(buf, sizeof(buf), "AT+CRLA=%i,192,%i", session_id,
+ fileid);
+
+ switch (sd->vendor) {
+ default:
+ if (path_len == 0)
+ break;
+
+ /* Fall through */
+ case OFONO_VENDOR_ZTE:
+ case OFONO_VENDOR_HUAWEI:
+ case OFONO_VENDOR_SIERRA:
+ case OFONO_VENDOR_SPEEDUP:
+ case OFONO_VENDOR_QUALCOMM_MSM:
+ case OFONO_VENDOR_SIMCOM:
+ /* Maximum possible length */
+ len += sprintf(buf + len, ",0,0,255");
+ break;
+ }
+
+ if (path_len > 0) {
+ len += sprintf(buf + len, ",,\"");
+
+ for (; path_len; path_len--)
+ len += sprintf(buf + len, "%02hhX", *path++);
+
+ buf[len++] = '\"';
+ buf[len] = '\0';
+ }
+
+ if (g_at_chat_send(sd->chat, buf, crla_prefix,
+ at_crla_info_cb, cbd, g_free) > 0)
+ return;
+
+ g_free(cbd);
+
+ CALLBACK_WITH_FAILURE(cb, -1, -1, -1, NULL,
+ EF_STATUS_INVALIDATED, data);
+}
+
static int at_sim_probe(struct ofono_sim *sim, unsigned int vendor,
void *data)
{
@@ -1662,6 +2041,12 @@ static struct ofono_sim_driver driver = {
.lock = at_pin_enable,
.change_passwd = at_change_passwd,
.query_facility_lock = at_query_clck,
+ .list_apps = at_discover_apps,
+ .open_channel = at_open_channel,
+ .close_channel = at_close_channel,
+ .session_read_binary = at_session_read_binary,
+ .session_read_record = at_session_read_record,
+ .session_read_info = at_session_read_info,
};
static struct ofono_sim_driver driver_noef = {
--
2.7.4