mirror of
https://github.com/sailfishos/ofono
synced 2025-12-02 07:31:04 +08:00
ddfe8acf11
Add ofono_sim_inserted_notify function to notify the core of SIM insertion / removal. Make every plugin generate a sim inserted event on start. For devices with removable card, the event should be emitted after the plugin detects such event. For devices that need to wait for SIM card initialization, they can emit this event later.
360 lines
8.1 KiB
C
360 lines
8.1 KiB
C
/*
|
|
*
|
|
* oFono - Open Source Telephony
|
|
*
|
|
* Copyright (C) 2008-2010 Intel Corporation. All rights reserved.
|
|
*
|
|
* 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 <config.h>
|
|
#endif
|
|
|
|
#include <errno.h>
|
|
#include <unistd.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <sys/socket.h>
|
|
#include <netinet/in.h>
|
|
#include <arpa/inet.h>
|
|
|
|
#include <glib.h>
|
|
#include <gatmux.h>
|
|
#include <gatchat.h>
|
|
|
|
#define OFONO_API_SUBJECT_TO_CHANGE
|
|
#include <ofono/plugin.h>
|
|
#include <ofono/log.h>
|
|
#include <ofono/modem.h>
|
|
#include <ofono/call-barring.h>
|
|
#include <ofono/call-forwarding.h>
|
|
#include <ofono/call-meter.h>
|
|
#include <ofono/call-settings.h>
|
|
#include <ofono/call-volume.h>
|
|
#include <ofono/cbs.h>
|
|
#include <ofono/devinfo.h>
|
|
#include <ofono/message-waiting.h>
|
|
#include <ofono/netreg.h>
|
|
#include <ofono/phonebook.h>
|
|
#include <ofono/sim.h>
|
|
#include <ofono/sms.h>
|
|
#include <ofono/ssn.h>
|
|
#include <ofono/ussd.h>
|
|
#include <ofono/voicecall.h>
|
|
#include <ofono/gprs.h>
|
|
#include <ofono/gprs-context.h>
|
|
|
|
#include <drivers/atmodem/vendor.h>
|
|
|
|
struct phonesim_data {
|
|
GAtMux *mux;
|
|
GAtChat *chat;
|
|
gboolean calypso;
|
|
gboolean use_mux;
|
|
};
|
|
|
|
static int phonesim_probe(struct ofono_modem *modem)
|
|
{
|
|
struct phonesim_data *data;
|
|
|
|
DBG("%p", modem);
|
|
|
|
data = g_try_new0(struct phonesim_data, 1);
|
|
if (!data)
|
|
return -ENOMEM;
|
|
|
|
ofono_modem_set_data(modem, data);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void phonesim_remove(struct ofono_modem *modem)
|
|
{
|
|
struct phonesim_data *data = ofono_modem_get_data(modem);
|
|
|
|
DBG("%p", modem);
|
|
|
|
g_free(data);
|
|
ofono_modem_set_data(modem, NULL);
|
|
}
|
|
|
|
static void phonesim_debug(const char *str, void *user_data)
|
|
{
|
|
ofono_info("%s", str);
|
|
}
|
|
|
|
static void cfun_set_on_cb(gboolean ok, GAtResult *result, gpointer user_data)
|
|
{
|
|
struct ofono_modem *modem = user_data;
|
|
|
|
DBG("");
|
|
|
|
ofono_modem_set_powered(modem, ok);
|
|
}
|
|
|
|
static void phonesim_disconnected(gpointer user_data)
|
|
{
|
|
struct ofono_modem *modem = user_data;
|
|
struct phonesim_data *data = ofono_modem_get_data(modem);
|
|
|
|
DBG("");
|
|
|
|
ofono_modem_set_powered(modem, FALSE);
|
|
|
|
g_at_chat_unref(data->chat);
|
|
data->chat = NULL;
|
|
|
|
if (data->mux) {
|
|
g_at_mux_shutdown(data->mux);
|
|
g_at_mux_unref(data->mux);
|
|
data->mux = NULL;
|
|
}
|
|
}
|
|
|
|
static void mux_setup(GAtMux *mux, gpointer user_data)
|
|
{
|
|
struct ofono_modem *modem = user_data;
|
|
struct phonesim_data *data = ofono_modem_get_data(modem);
|
|
GIOChannel *io;
|
|
GAtSyntax *syntax;
|
|
|
|
DBG("%p", mux);
|
|
|
|
if (!mux) {
|
|
ofono_modem_set_powered(modem, FALSE);
|
|
return;
|
|
}
|
|
|
|
data->mux = mux;
|
|
|
|
if (getenv("OFONO_AT_DEBUG"))
|
|
g_at_mux_set_debug(data->mux, phonesim_debug, NULL);
|
|
|
|
g_at_mux_start(mux);
|
|
io = g_at_mux_create_channel(mux);
|
|
|
|
if (data->calypso)
|
|
syntax = g_at_syntax_new_gsm_permissive();
|
|
else
|
|
syntax = g_at_syntax_new_gsmv1();
|
|
|
|
data->chat = g_at_chat_new(io, syntax);
|
|
g_at_syntax_unref(syntax);
|
|
g_io_channel_unref(io);
|
|
|
|
if (getenv("OFONO_AT_DEBUG"))
|
|
g_at_chat_set_debug(data->chat, phonesim_debug, NULL);
|
|
|
|
if (data->calypso)
|
|
g_at_chat_set_wakeup_command(data->chat, "AT\r", 500, 5000);
|
|
|
|
g_at_chat_send(data->chat, "AT+CFUN=1", NULL,
|
|
cfun_set_on_cb, modem, NULL);
|
|
}
|
|
|
|
static int phonesim_enable(struct ofono_modem *modem)
|
|
{
|
|
struct phonesim_data *data = ofono_modem_get_data(modem);
|
|
GIOChannel *io;
|
|
GAtSyntax *syntax;
|
|
struct sockaddr_in addr;
|
|
const char *address, *value;
|
|
int sk, err, port;
|
|
|
|
DBG("%p", modem);
|
|
|
|
address = ofono_modem_get_string(modem, "Address");
|
|
if (!address)
|
|
return -EINVAL;
|
|
|
|
port = ofono_modem_get_integer(modem, "Port");
|
|
if (port < 0)
|
|
return -EINVAL;
|
|
|
|
value = ofono_modem_get_string(modem, "Modem");
|
|
if (!g_strcmp0(value, "calypso"))
|
|
data->calypso = TRUE;
|
|
|
|
value = ofono_modem_get_string(modem, "Multiplexer");
|
|
if (!g_strcmp0(value, "internal"))
|
|
data->use_mux = TRUE;
|
|
|
|
sk = socket(PF_INET, SOCK_STREAM, 0);
|
|
if (sk < 0)
|
|
return -EINVAL;
|
|
|
|
memset(&addr, 0, sizeof(addr));
|
|
addr.sin_family = AF_INET;
|
|
addr.sin_addr.s_addr = inet_addr(address);
|
|
addr.sin_port = htons(port);
|
|
|
|
err = connect(sk, (struct sockaddr *) &addr, sizeof(addr));
|
|
if (err < 0) {
|
|
close(sk);
|
|
return err;
|
|
}
|
|
|
|
io = g_io_channel_unix_new(sk);
|
|
if (!io) {
|
|
close(sk);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
if (data->calypso)
|
|
syntax = g_at_syntax_new_gsm_permissive();
|
|
else
|
|
syntax = g_at_syntax_new_gsmv1();
|
|
|
|
data->chat = g_at_chat_new(io, syntax);
|
|
|
|
g_at_syntax_unref(syntax);
|
|
g_io_channel_unref(io);
|
|
|
|
if (!data->chat)
|
|
return -ENOMEM;
|
|
|
|
if (getenv("OFONO_AT_DEBUG"))
|
|
g_at_chat_set_debug(data->chat, phonesim_debug, NULL);
|
|
|
|
g_at_chat_set_disconnect_function(data->chat,
|
|
phonesim_disconnected, modem);
|
|
|
|
if (data->calypso) {
|
|
g_at_chat_set_wakeup_command(data->chat, "AT\r", 500, 5000);
|
|
|
|
g_at_chat_send(data->chat, "ATE0", NULL, NULL, NULL, NULL);
|
|
|
|
g_at_chat_send(data->chat, "AT%CUNS=0",
|
|
NULL, NULL, NULL, NULL);
|
|
}
|
|
|
|
if (data->use_mux) {
|
|
g_at_mux_setup_gsm0710(data->chat, mux_setup, modem, NULL);
|
|
g_at_chat_unref(data->chat);
|
|
data->chat = NULL;
|
|
} else {
|
|
g_at_chat_send(data->chat, "AT+CFUN=1", NULL,
|
|
cfun_set_on_cb, modem, NULL);
|
|
}
|
|
|
|
return -EINPROGRESS;
|
|
}
|
|
|
|
static int phonesim_disable(struct ofono_modem *modem)
|
|
{
|
|
struct phonesim_data *data = ofono_modem_get_data(modem);
|
|
|
|
DBG("%p", modem);
|
|
|
|
g_at_chat_shutdown(data->chat);
|
|
|
|
g_at_chat_unref(data->chat);
|
|
data->chat = NULL;
|
|
|
|
if (data->mux) {
|
|
g_at_mux_shutdown(data->mux);
|
|
|
|
g_at_mux_unref(data->mux);
|
|
data->mux = NULL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void phonesim_pre_sim(struct ofono_modem *modem)
|
|
{
|
|
struct phonesim_data *data = ofono_modem_get_data(modem);
|
|
struct ofono_sim *sim;
|
|
|
|
DBG("%p", modem);
|
|
|
|
ofono_devinfo_create(modem, 0, "atmodem", data->chat);
|
|
sim = ofono_sim_create(modem, 0, "atmodem", data->chat);
|
|
|
|
if (data->calypso)
|
|
ofono_voicecall_create(modem, 0, "calypsomodem", data->chat);
|
|
else
|
|
ofono_voicecall_create(modem, 0, "atmodem", data->chat);
|
|
|
|
if (sim)
|
|
ofono_sim_inserted_notify(sim, TRUE);
|
|
}
|
|
|
|
static void phonesim_post_sim(struct ofono_modem *modem)
|
|
{
|
|
struct phonesim_data *data = ofono_modem_get_data(modem);
|
|
struct ofono_message_waiting *mw;
|
|
struct ofono_gprs *gprs;
|
|
struct ofono_gprs_context *gc;
|
|
|
|
DBG("%p", modem);
|
|
|
|
ofono_ussd_create(modem, 0, "atmodem", data->chat);
|
|
ofono_call_forwarding_create(modem, 0, "atmodem", data->chat);
|
|
ofono_call_settings_create(modem, 0, "atmodem", data->chat);
|
|
|
|
if (data->calypso)
|
|
ofono_netreg_create(modem, OFONO_VENDOR_CALYPSO,
|
|
"atmodem", data->chat);
|
|
else
|
|
ofono_netreg_create(modem, OFONO_VENDOR_PHONESIM,
|
|
"atmodem", data->chat);
|
|
|
|
ofono_call_meter_create(modem, 0, "atmodem", data->chat);
|
|
ofono_call_barring_create(modem, 0, "atmodem", data->chat);
|
|
ofono_ssn_create(modem, 0, "atmodem", data->chat);
|
|
ofono_call_volume_create(modem, 0, "atmodem", data->chat);
|
|
|
|
if (!data->calypso) {
|
|
ofono_sms_create(modem, 0, "atmodem", data->chat);
|
|
ofono_phonebook_create(modem, 0, "atmodem", data->chat);
|
|
ofono_cbs_create(modem, 0, "atmodem", data->chat);
|
|
}
|
|
|
|
gprs = ofono_gprs_create(modem, 0, "atmodem", data->chat);
|
|
gc = ofono_gprs_context_create(modem, 0, "atmodem", data->chat);
|
|
|
|
if (gprs && gc)
|
|
ofono_gprs_add_context(gprs, gc);
|
|
|
|
mw = ofono_message_waiting_create(modem);
|
|
if (mw)
|
|
ofono_message_waiting_register(mw);
|
|
}
|
|
|
|
static struct ofono_modem_driver phonesim_driver = {
|
|
.name = "phonesim",
|
|
.probe = phonesim_probe,
|
|
.remove = phonesim_remove,
|
|
.enable = phonesim_enable,
|
|
.disable = phonesim_disable,
|
|
.pre_sim = phonesim_pre_sim,
|
|
.post_sim = phonesim_post_sim
|
|
};
|
|
|
|
static int phonesim_init(void)
|
|
{
|
|
return ofono_modem_driver_register(&phonesim_driver);
|
|
}
|
|
|
|
static void phonesim_exit(void)
|
|
{
|
|
ofono_modem_driver_unregister(&phonesim_driver);
|
|
}
|
|
|
|
OFONO_PLUGIN_DEFINE(phonesim, "PhoneSIM driver", VERSION,
|
|
OFONO_PLUGIN_PRIORITY_DEFAULT, phonesim_init, phonesim_exit)
|