mirror of git://git.sysmocom.de/ofono
telit: init modem normally once SAP was enabled
This commit is contained in:
Gustavo F. Padovan
Denis Kenzior
parent
deca4a32d3
commit
e07b4217aa
271
plugins/telit.c
271
plugins/telit.c
|
|
@ -211,9 +211,142 @@ static GAtChat *open_device(struct ofono_modem *modem,
|
|||
return chat;
|
||||
}
|
||||
|
||||
static gboolean sim_inserted_timeout_cb(gpointer user_data)
|
||||
{
|
||||
struct ofono_modem *modem = user_data;
|
||||
struct telit_data *data = ofono_modem_get_data(modem);
|
||||
|
||||
DBG("%p", modem);
|
||||
|
||||
data->sim_inserted_source = 0;
|
||||
|
||||
ofono_sim_inserted_notify(data->sim, TRUE);
|
||||
|
||||
return FALSE;
|
||||
}
|
||||
|
||||
static void switch_sim_state_status(struct ofono_modem *modem, int status)
|
||||
{
|
||||
struct telit_data *data = ofono_modem_get_data(modem);
|
||||
|
||||
DBG("%p", modem);
|
||||
|
||||
switch (status) {
|
||||
case 0:
|
||||
DBG("SIM not inserted");
|
||||
ofono_sim_inserted_notify(data->sim, FALSE);
|
||||
break;
|
||||
case 1:
|
||||
DBG("SIM inserted");
|
||||
/* We need to sleep a bit */
|
||||
data->sim_inserted_source = g_timeout_add_seconds(1,
|
||||
sim_inserted_timeout_cb,
|
||||
modem);
|
||||
break;
|
||||
case 2:
|
||||
DBG("SIM inserted and PIN unlocked");
|
||||
break;
|
||||
case 3:
|
||||
DBG("SIM inserted and ready");
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
static void telit_qss_notify(GAtResult *result, gpointer user_data)
|
||||
{
|
||||
struct ofono_modem *modem = user_data;
|
||||
int status;
|
||||
GAtResultIter iter;
|
||||
|
||||
DBG("%p", modem);
|
||||
|
||||
g_at_result_iter_init(&iter, result);
|
||||
|
||||
if (!g_at_result_iter_next(&iter, "#QSS:"))
|
||||
return;
|
||||
|
||||
g_at_result_iter_next_number(&iter, &status);
|
||||
|
||||
switch_sim_state_status(modem, status);
|
||||
}
|
||||
|
||||
static void telit_qss_cb(gboolean ok, GAtResult *result, gpointer user_data)
|
||||
{
|
||||
struct ofono_modem *modem = user_data;
|
||||
int mode;
|
||||
int status;
|
||||
GAtResultIter iter;
|
||||
g_at_result_iter_init(&iter, result);
|
||||
|
||||
DBG("%p", modem);
|
||||
|
||||
if (!g_at_result_iter_next(&iter, "#QSS:"))
|
||||
return;
|
||||
|
||||
g_at_result_iter_next_number(&iter, &mode);
|
||||
g_at_result_iter_next_number(&iter, &status);
|
||||
|
||||
switch_sim_state_status(modem, status);
|
||||
}
|
||||
|
||||
static void cfun_enable_cb(gboolean ok, GAtResult *result, gpointer user_data)
|
||||
{
|
||||
struct ofono_modem *modem = user_data;
|
||||
struct telit_data *data = ofono_modem_get_data(modem);
|
||||
struct ofono_modem *m = data->sap_modem ? : modem;
|
||||
|
||||
DBG("%p", modem);
|
||||
|
||||
if (!ok) {
|
||||
g_at_chat_unref(data->chat);
|
||||
data->chat = NULL;
|
||||
ofono_modem_set_powered(m, FALSE);
|
||||
sap_close_io(modem);
|
||||
return;
|
||||
}
|
||||
|
||||
ofono_modem_set_powered(m, TRUE);
|
||||
|
||||
/* Enable sim state notification */
|
||||
g_at_chat_send(data->chat, "AT#QSS=1", none_prefix, NULL, NULL, NULL);
|
||||
|
||||
/* Follow sim state */
|
||||
g_at_chat_register(data->chat, "#QSS:", telit_qss_notify,
|
||||
FALSE, modem, NULL);
|
||||
|
||||
/* Query current sim state */
|
||||
g_at_chat_send(data->chat, "AT#QSS?", qss_prefix,
|
||||
telit_qss_cb, modem, NULL);
|
||||
}
|
||||
|
||||
static int telit_enable(struct ofono_modem *modem)
|
||||
{
|
||||
struct telit_data *data = ofono_modem_get_data(modem);
|
||||
|
||||
DBG("%p", modem);
|
||||
|
||||
data->chat = open_device(modem, "Modem", "Modem: ");
|
||||
if (data->chat == NULL)
|
||||
return -EINVAL;
|
||||
|
||||
/*
|
||||
* Disable command echo and
|
||||
* enable the Extended Error Result Codes
|
||||
*/
|
||||
g_at_chat_send(data->chat, "ATE0 +CMEE=1", none_prefix,
|
||||
NULL, NULL, NULL);
|
||||
|
||||
/* Set phone functionality */
|
||||
g_at_chat_send(data->chat, "AT+CFUN=4", none_prefix,
|
||||
cfun_enable_cb, modem, NULL);
|
||||
|
||||
return -EINPROGRESS;
|
||||
}
|
||||
|
||||
static void telit_rsen_notify(GAtResult *result, gpointer user_data)
|
||||
{
|
||||
struct ofono_modem *modem = user_data;
|
||||
struct telit_data *data = ofono_modem_get_data(modem);
|
||||
int status;
|
||||
GAtResultIter iter;
|
||||
|
||||
|
|
@ -225,6 +358,14 @@ static void telit_rsen_notify(GAtResult *result, gpointer user_data)
|
|||
return;
|
||||
|
||||
g_at_result_iter_next_number(&iter, &status);
|
||||
|
||||
if (status == 0) {
|
||||
ofono_modem_set_powered(data->sap_modem, FALSE);
|
||||
sap_close_io(modem);
|
||||
return;
|
||||
}
|
||||
|
||||
telit_enable(modem);
|
||||
}
|
||||
|
||||
static void rsen_enable_cb(gboolean ok, GAtResult *result, gpointer user_data)
|
||||
|
|
@ -437,136 +578,6 @@ static void telit_remove(struct ofono_modem *modem)
|
|||
g_free(data);
|
||||
}
|
||||
|
||||
static gboolean sim_inserted_timeout_cb(gpointer user_data)
|
||||
{
|
||||
struct ofono_modem *modem = user_data;
|
||||
struct telit_data *data = ofono_modem_get_data(modem);
|
||||
|
||||
DBG("%p", modem);
|
||||
|
||||
data->sim_inserted_source = 0;
|
||||
|
||||
ofono_sim_inserted_notify(data->sim, TRUE);
|
||||
|
||||
return FALSE;
|
||||
}
|
||||
|
||||
static void switch_sim_state_status(struct ofono_modem *modem, int status)
|
||||
{
|
||||
struct telit_data *data = ofono_modem_get_data(modem);
|
||||
|
||||
DBG("%p", modem);
|
||||
|
||||
switch (status) {
|
||||
case 0:
|
||||
DBG("SIM not inserted");
|
||||
ofono_sim_inserted_notify(data->sim, FALSE);
|
||||
break;
|
||||
case 1:
|
||||
DBG("SIM inserted");
|
||||
/* We need to sleep a bit */
|
||||
data->sim_inserted_source = g_timeout_add_seconds(1,
|
||||
sim_inserted_timeout_cb,
|
||||
modem);
|
||||
break;
|
||||
case 2:
|
||||
DBG("SIM inserted and PIN unlocked");
|
||||
break;
|
||||
case 3:
|
||||
DBG("SIM inserted and ready");
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
static void telit_qss_notify(GAtResult *result, gpointer user_data)
|
||||
{
|
||||
struct ofono_modem *modem = user_data;
|
||||
int status;
|
||||
GAtResultIter iter;
|
||||
|
||||
DBG("%p", modem);
|
||||
|
||||
g_at_result_iter_init(&iter, result);
|
||||
|
||||
if (!g_at_result_iter_next(&iter, "#QSS:"))
|
||||
return;
|
||||
|
||||
g_at_result_iter_next_number(&iter, &status);
|
||||
|
||||
switch_sim_state_status(modem, status);
|
||||
}
|
||||
|
||||
static void telit_qss_cb(gboolean ok, GAtResult *result, gpointer user_data)
|
||||
{
|
||||
struct ofono_modem *modem = user_data;
|
||||
int mode;
|
||||
int status;
|
||||
GAtResultIter iter;
|
||||
g_at_result_iter_init(&iter, result);
|
||||
|
||||
DBG("%p", modem);
|
||||
|
||||
if (!g_at_result_iter_next(&iter, "#QSS:"))
|
||||
return;
|
||||
|
||||
g_at_result_iter_next_number(&iter, &mode);
|
||||
g_at_result_iter_next_number(&iter, &status);
|
||||
|
||||
switch_sim_state_status(modem, status);
|
||||
}
|
||||
|
||||
static void cfun_enable_cb(gboolean ok, GAtResult *result, gpointer user_data)
|
||||
{
|
||||
struct ofono_modem *modem = user_data;
|
||||
struct telit_data *data = ofono_modem_get_data(modem);
|
||||
|
||||
DBG("%p", modem);
|
||||
|
||||
if (!ok) {
|
||||
g_at_chat_unref(data->chat);
|
||||
data->chat = NULL;
|
||||
ofono_modem_set_powered(modem, FALSE);
|
||||
return;
|
||||
}
|
||||
|
||||
ofono_modem_set_powered(modem, TRUE);
|
||||
|
||||
/* Enable sim state notification */
|
||||
g_at_chat_send(data->chat, "AT#QSS=1", none_prefix, NULL, NULL, NULL);
|
||||
|
||||
/* Follow sim state */
|
||||
g_at_chat_register(data->chat, "#QSS:", telit_qss_notify,
|
||||
FALSE, modem, NULL);
|
||||
|
||||
/* Query current sim state */
|
||||
g_at_chat_send(data->chat, "AT#QSS?", qss_prefix,
|
||||
telit_qss_cb, modem, NULL);
|
||||
}
|
||||
|
||||
static int telit_enable(struct ofono_modem *modem)
|
||||
{
|
||||
struct telit_data *data = ofono_modem_get_data(modem);
|
||||
|
||||
DBG("%p", modem);
|
||||
|
||||
data->chat = open_device(modem, "Modem", "Modem: ");
|
||||
if (data->chat == NULL)
|
||||
return -EINVAL;
|
||||
|
||||
/*
|
||||
* Disable command echo and
|
||||
* enable the Extended Error Result Codes
|
||||
*/
|
||||
g_at_chat_send(data->chat, "ATE0 +CMEE=1", none_prefix,
|
||||
NULL, NULL, NULL);
|
||||
|
||||
/* Set phone functionality */
|
||||
g_at_chat_send(data->chat, "AT+CFUN=4", none_prefix,
|
||||
cfun_enable_cb, modem, NULL);
|
||||
|
||||
return -EINPROGRESS;
|
||||
}
|
||||
|
||||
static void set_online_cb(gboolean ok, GAtResult *result, gpointer user_data)
|
||||
{
|
||||
struct cb_data *cbd = user_data;
|
||||
|
|
|
|||
Loading…
Reference in New Issue