From 521396d55bcc46a3dcff9cb977709e957e2c0127 Mon Sep 17 00:00:00 2001 From: Marcel Holtmann Date: Sun, 26 Sep 2010 23:51:27 +0900 Subject: [PATCH] huaweimodem: Add skeleton for simple voice call driver --- Makefile.am | 1 + drivers/huaweimodem/huaweimodem.c | 2 + drivers/huaweimodem/huaweimodem.h | 3 + drivers/huaweimodem/voicecall.c | 204 ++++++++++++++++++++++++++++++ 4 files changed, 210 insertions(+) create mode 100644 drivers/huaweimodem/voicecall.c diff --git a/Makefile.am b/Makefile.am index 3c22e096..73de3597 100644 --- a/Makefile.am +++ b/Makefile.am @@ -173,6 +173,7 @@ builtin_modules += huaweimodem builtin_sources += drivers/atmodem/atutil.h \ drivers/huaweimodem/huaweimodem.h \ drivers/huaweimodem/huaweimodem.c \ + drivers/huaweimodem/voicecall.c \ drivers/huaweimodem/gprs-context.c builtin_modules += calypsomodem diff --git a/drivers/huaweimodem/huaweimodem.c b/drivers/huaweimodem/huaweimodem.c index 567cbbf8..22a2d454 100644 --- a/drivers/huaweimodem/huaweimodem.c +++ b/drivers/huaweimodem/huaweimodem.c @@ -34,6 +34,7 @@ static int huaweimodem_init(void) { + huawei_voicecall_init(); huawei_gprs_context_init(); return 0; @@ -42,6 +43,7 @@ static int huaweimodem_init(void) static void huaweimodem_exit(void) { huawei_gprs_context_exit(); + huawei_voicecall_exit(); } OFONO_PLUGIN_DEFINE(huaweimodem, "Huawei modem driver", VERSION, diff --git a/drivers/huaweimodem/huaweimodem.h b/drivers/huaweimodem/huaweimodem.h index 91b51801..b15cec74 100644 --- a/drivers/huaweimodem/huaweimodem.h +++ b/drivers/huaweimodem/huaweimodem.h @@ -21,5 +21,8 @@ #include +extern void huawei_voicecall_init(); +extern void huawei_voicecall_exit(); + extern void huawei_gprs_context_init(); extern void huawei_gprs_context_exit(); diff --git a/drivers/huaweimodem/voicecall.c b/drivers/huaweimodem/voicecall.c new file mode 100644 index 00000000..e9e4fa5c --- /dev/null +++ b/drivers/huaweimodem/voicecall.c @@ -0,0 +1,204 @@ +/* + * + * 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 +#endif + +#define _GNU_SOURCE +#include +#include +#include +#include + +#include + +#include +#include +#include + +#include "gatchat.h" +#include "gatresult.h" + +#include "huaweimodem.h" + +static const char *none_prefix[] = { NULL }; + +struct voicecall_data { + GAtChat *chat; +}; + +static void cring_notify(GAtResult *result, gpointer user_data) +{ + GAtResultIter iter; + const char *line; + int type; + + g_at_result_iter_init(&iter, result); + + if (!g_at_result_iter_next(&iter, "+CRING:")) + return; + + line = g_at_result_iter_raw_line(&iter); + + if (line == NULL) + return; + + /* Ignore everything that is not voice for now */ + if (!strcasecmp(line, "VOICE")) + type = 0; + else + type = 9; + + /* Assume the CLIP always arrives, and we signal the call there */ + DBG("%d", type); +} + +static void clip_notify(GAtResult *result, gpointer user_data) +{ + GAtResultIter iter; + const char *num; + int type, validity; + + g_at_result_iter_init(&iter, result); + + if (!g_at_result_iter_next(&iter, "+CLIP:")) + return; + + if (!g_at_result_iter_next_string(&iter, &num)) + return; + + if (!g_at_result_iter_next_number(&iter, &type)) + return; + + if (strlen(num) > 0) + validity = 0; + else + validity = 2; + + /* Skip subaddr, satype and alpha */ + g_at_result_iter_skip_next(&iter); + g_at_result_iter_skip_next(&iter); + g_at_result_iter_skip_next(&iter); + + /* If we have CLI validity field, override our guessed value */ + g_at_result_iter_next_number(&iter, &validity); + + DBG("%s %d %d", num, type, validity); +} + +static void ccwa_notify(GAtResult *result, gpointer user_data) +{ + GAtResultIter iter; + const char *num; + int num_type, validity, cls; + + g_at_result_iter_init(&iter, result); + + if (!g_at_result_iter_next(&iter, "+CCWA:")) + return; + + if (!g_at_result_iter_next_string(&iter, &num)) + return; + + if (!g_at_result_iter_next_number(&iter, &num_type)) + return; + + if (!g_at_result_iter_next_number(&iter, &cls)) + return; + + /* Skip alpha field */ + g_at_result_iter_skip_next(&iter); + + if (strlen(num) > 0) + validity = 0; + else + validity = 2; + + /* If we have CLI validity field, override our guessed value */ + g_at_result_iter_next_number(&iter, &validity); + + DBG("%s %d %d %d", num, num_type, cls, validity); +} + +static void huawei_voicecall_initialized(gboolean ok, GAtResult *result, + gpointer user_data) +{ + struct ofono_voicecall *vc = user_data; + struct voicecall_data *vd = ofono_voicecall_get_data(vc); + + DBG("registering to notifications"); + + g_at_chat_register(vd->chat, "+CRING:", cring_notify, FALSE, vc, NULL); + g_at_chat_register(vd->chat, "+CLIP:", clip_notify, FALSE, vc, NULL); + g_at_chat_register(vd->chat, "+CCWA:", ccwa_notify, FALSE, vc, NULL); + + ofono_voicecall_register(vc); +} + +static int huawei_voicecall_probe(struct ofono_voicecall *vc, + unsigned int vendor, void *data) +{ + GAtChat *chat = data; + struct voicecall_data *vd; + + vd = g_try_new0(struct voicecall_data, 1); + if (!vd) + return -ENOMEM; + + vd->chat = g_at_chat_clone(chat); + + ofono_voicecall_set_data(vc, vd); + + g_at_chat_send(vd->chat, "AT+CRC=1", none_prefix, NULL, NULL, NULL); + g_at_chat_send(vd->chat, "AT+CLIP=1", none_prefix, NULL, NULL, NULL); + g_at_chat_send(vd->chat, "AT+COLP=1", none_prefix, NULL, NULL, NULL); + g_at_chat_send(vd->chat, "AT+CCWA=1", none_prefix, + huawei_voicecall_initialized, vc, NULL); + + return 0; +} + +static void huawei_voicecall_remove(struct ofono_voicecall *vc) +{ + struct voicecall_data *vd = ofono_voicecall_get_data(vc); + + ofono_voicecall_set_data(vc, NULL); + + g_at_chat_unref(vd->chat); + g_free(vd); +} + +static struct ofono_voicecall_driver driver = { + .name = "huaweimodem", + .probe = huawei_voicecall_probe, + .remove = huawei_voicecall_remove, +}; + +void huawei_voicecall_init() +{ + ofono_voicecall_driver_register(&driver); +} + +void huawei_voicecall_exit() +{ + ofono_voicecall_driver_unregister(&driver); +}