/* * This file is part of oFono - Open Source Telephony * * Copyright (C) 2009 Nokia Corporation and/or its subsidiary(-ies). * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License * version 2 as published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, but * WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA * 02110-1301 USA * */ #ifdef HAVE_CONFIG_H #include #endif #include #include #include #include #include #include #include #define OFONO_API_SUBJECT_TO_CHANGE #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "isimodem.h" #include "isiutil.h" #include "mtc.h" #include "debug.h" struct isi_data { struct ofono_modem *modem; char const *ifname; GIsiModem *idx; GIsiClient *client; GPhonetNetlink *link; GPhonetLinkState linkstate; unsigned interval; int reported; int mtc_state; }; static void report_powered(struct isi_data *isi, ofono_bool_t powered) { if (powered != isi->reported) ofono_modem_set_powered(isi->modem, isi->reported = powered); } static void set_power_by_mtc_state(struct isi_data *isi, int state) { switch (isi->mtc_state = state) { case MTC_STATE_NONE: case MTC_POWER_OFF: case MTC_CHARGING: case MTC_SELFTEST_FAIL: report_powered(isi, 0); break; case MTC_RF_INACTIVE: case MTC_NORMAL: report_powered(isi, 1); break; default: report_powered(isi, 1); } } static void mtc_state_ind_cb(GIsiClient *client, const void *restrict data, size_t len, uint16_t object, void *opaque) { const unsigned char *msg = data; struct isi_data *isi = opaque; if (!msg) { DBG("ISI client error: %d", g_isi_client_error(client)); return; } if (len < 3 || msg[0] != MTC_STATE_INFO_IND) return; if (msg[2] == MTC_START) { DBG("target modem state: %s (0x%02X)", mtc_modem_state_name(msg[1]), msg[1]); } else if (msg[2] == MTC_READY) { DBG("current modem state: %s (0x%02X)", mtc_modem_state_name(msg[1]), msg[1]); set_power_by_mtc_state(isi, msg[1]); } } static gboolean mtc_poll_query_cb(GIsiClient *client, const void *restrict data, size_t len, uint16_t object, void *opaque) { const unsigned char *msg = data; struct isi_data *isi = opaque; if (!msg) { const unsigned char req[] = { MTC_STATE_QUERY_REQ, 0x00, 0x00 }; if (isi->linkstate != PN_LINK_UP) return TRUE; isi->interval *= 2; if (isi->interval >= 20) isi->interval = 20; g_isi_request_make(client, req, sizeof(req), isi->interval, mtc_poll_query_cb, opaque); return TRUE; } if (len < 3 || msg[0] != MTC_STATE_QUERY_RESP) return FALSE; g_isi_subscribe(client, MTC_STATE_INFO_IND, mtc_state_ind_cb, opaque); DBG("current modem state: %s (0x%02X)", mtc_modem_state_name(msg[1]), msg[1]); DBG("target modem state: %s (0x%02X)", mtc_modem_state_name(msg[2]), msg[2]); set_power_by_mtc_state(isi, msg[1]); return TRUE; } static gboolean mtc_query_cb(GIsiClient *client, const void *restrict data, size_t len, uint16_t object, void *opaque) { const unsigned char *msg = data; struct isi_data *isi = opaque; if (!msg) { DBG("ISI client error: %d", g_isi_client_error(client)); return TRUE; } if (len < 3 || msg[0] != MTC_STATE_QUERY_RESP) return FALSE; DBG("current modem state: %s (0x%02X)", mtc_modem_state_name(msg[1]), msg[1]); DBG("target modem state: %s (0x%02X)", mtc_modem_state_name(msg[2]), msg[2]); set_power_by_mtc_state(isi, msg[1]); return TRUE; } static void reachable_cb(GIsiClient *client, gboolean alive, uint16_t object, void *opaque) { struct isi_data *isi = opaque; const unsigned char msg[] = { MTC_STATE_QUERY_REQ, 0x00, 0x00 /* Filler */ }; if (!alive) { DBG("MTC client: %s", strerror(-g_isi_client_error(client))); if (isi->linkstate == PN_LINK_UP) g_isi_request_make(client, msg, sizeof(msg), isi->interval = MTC_TIMEOUT, mtc_poll_query_cb, opaque); return; } DBG("%s (v.%03d.%03d) reachable", pn_resource_name(g_isi_client_resource(client)), g_isi_version_major(client), g_isi_version_minor(client)); g_isi_subscribe(client, MTC_STATE_INFO_IND, mtc_state_ind_cb, opaque); g_isi_request_make(client, msg, sizeof(msg), MTC_TIMEOUT, mtc_query_cb, opaque); } static void phonet_status_cb(GIsiModem *idx, GPhonetLinkState st, char const *ifname, void *data) { struct ofono_modem *modem = data; struct isi_data *isi = ofono_modem_get_data(modem); DBG("Link %s (%u) is %s", isi->ifname, g_isi_modem_index(isi->idx), st == PN_LINK_REMOVED ? "removed" : st == PN_LINK_DOWN ? "down" : "up"); isi->linkstate = st; if (st == PN_LINK_UP) g_isi_verify(isi->client, reachable_cb, isi); else if (st == PN_LINK_DOWN) set_power_by_mtc_state(isi, MTC_STATE_NONE); else if (st == PN_LINK_REMOVED) ofono_modem_remove(modem); } static int isi_modem_probe(struct ofono_modem *modem) { struct isi_data *isi; char const *ifname = ofono_modem_get_string(modem, "Interface"); GIsiModem *idx; GPhonetNetlink *link; if (ifname == NULL) return -EINVAL; DBG("(%p) with %s", modem, ifname); idx = g_isi_modem_by_name(ifname); if (idx == NULL) { DBG("Interface=%s: %s", ifname, strerror(errno)); return -errno; } if (g_pn_netlink_by_modem(idx)) { DBG("%s: %s", ifname, strerror(EBUSY)); return -EBUSY; } link = g_pn_netlink_start(idx, phonet_status_cb, modem); if (!link) { DBG("%s: %s", ifname, strerror(errno)); return -errno; } isi = g_new0(struct isi_data, 1); if (isi == NULL) return -ENOMEM; ofono_modem_set_data(isi->modem = modem, isi); isi->idx = idx; isi->ifname = ifname; isi->link = link; isi->client = g_isi_client_create(isi->idx, PN_MTC); return 0; } static void isi_modem_remove(struct ofono_modem *modem) { struct isi_data *isi = ofono_modem_get_data(modem); if (!isi) return; ofono_modem_set_data(modem, NULL); g_isi_client_destroy(isi->client); g_pn_netlink_stop(isi->link); g_free(isi); } static void isi_modem_pre_sim(struct ofono_modem *modem) { struct isi_data *isi = ofono_modem_get_data(modem); DBG("(%p) with %s", modem, isi->ifname); ofono_sim_create(isi->modem, 0, "isimodem", isi->idx); ofono_devinfo_create(isi->modem, 0, "isimodem", isi->idx); ofono_voicecall_create(isi->modem, 0, "isimodem", isi->idx); } static void isi_modem_post_sim(struct ofono_modem *modem) { struct isi_data *isi = ofono_modem_get_data(modem); struct ofono_gprs *gprs; struct ofono_gprs_context *gc; DBG("(%p) with %s", modem, isi->ifname); ofono_phonebook_create(isi->modem, 0, "isimodem", isi->idx); ofono_netreg_create(isi->modem, 0, "isimodem", isi->idx); ofono_sms_create(isi->modem, 0, "isimodem", isi->idx); ofono_cbs_create(isi->modem, 0, "isimodem", isi->idx); ofono_ssn_create(isi->modem, 0, "isimodem", isi->idx); ofono_ussd_create(isi->modem, 0, "isimodem", isi->idx); ofono_call_forwarding_create(isi->modem, 0, "isimodem", isi->idx); ofono_call_settings_create(isi->modem, 0, "isimodem", isi->idx); ofono_call_barring_create(isi->modem, 0, "isimodem", isi->idx); ofono_call_meter_create(isi->modem, 0, "isimodem", isi->idx); ofono_radio_settings_create(isi->modem, 0, "isimodem", isi->idx); gprs = ofono_gprs_create(isi->modem, 0, "isimodem", isi->idx); gc = ofono_gprs_context_create(isi->modem, 0, "isimodem", isi->idx); if (gprs && gc) ofono_gprs_add_context(gprs, gc); else DBG("Failed to add context"); } static struct ofono_modem_driver driver = { .name = "isimodem", .probe = isi_modem_probe, .remove = isi_modem_remove, .pre_sim = isi_modem_pre_sim, .post_sim = isi_modem_post_sim, }; static int isimodem_init(void) { isi_devinfo_init(); isi_phonebook_init(); isi_netreg_init(); isi_voicecall_init(); isi_sms_init(); isi_cbs_init(); isi_sim_init(); isi_ssn_init(); isi_ussd_init(); isi_call_forwarding_init(); isi_call_settings_init(); isi_call_barring_init(); isi_call_meter_init(); isi_radio_settings_init(); isi_gprs_init(); isi_gprs_context_init(); ofono_modem_driver_register(&driver); return 0; } static void isimodem_exit(void) { ofono_modem_driver_unregister(&driver); isi_devinfo_exit(); isi_phonebook_exit(); isi_netreg_exit(); isi_voicecall_exit(); isi_sms_exit(); isi_cbs_exit(); isi_sim_exit(); isi_ssn_exit(); isi_ussd_exit(); isi_call_forwarding_exit(); isi_call_settings_exit(); isi_call_barring_exit(); isi_call_meter_exit(); isi_radio_settings_exit(); isi_gprs_exit(); isi_gprs_context_exit(); } OFONO_PLUGIN_DEFINE(isimodem, "PhoNet / ISI modem driver", VERSION, OFONO_PLUGIN_PRIORITY_DEFAULT, isimodem_init, isimodem_exit)