Permalink
Cannot retrieve contributors at this time
Join GitHub today
GitHub is home to over 50 million developers working together to host and review code, manage projects, and build software together.
Sign up| /* | |
| * | |
| * oFono - Open Source Telephony | |
| * | |
| * Copyright (C) 2008-2011 Intel Corporation. All rights reserved. | |
| * Copyright (C) 2018 Gemalto M2M | |
| * | |
| * 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 <string.h> | |
| #include <stdlib.h> | |
| #include <stdio.h> | |
| #include <errno.h> | |
| #include <glib.h> | |
| #include <ofono/log.h> | |
| #include <ofono/modem.h> | |
| #include <ofono/voicecall.h> | |
| #include "gatchat.h" | |
| #include "gatresult.h" | |
| #include "common.h" | |
| #include "gemaltomodem.h" | |
| static const char *clcc_prefix[] = { "+CLCC:", NULL }; | |
| static const char *none_prefix[] = { NULL }; | |
| struct voicecall_data { | |
| GAtChat *chat; | |
| GSList *calls; | |
| unsigned int local_release; | |
| GSList *new_calls; | |
| }; | |
| struct release_id_req { | |
| struct ofono_voicecall *vc; | |
| ofono_voicecall_cb_t cb; | |
| void *data; | |
| int id; | |
| }; | |
| struct change_state_req { | |
| struct ofono_voicecall *vc; | |
| ofono_voicecall_cb_t cb; | |
| void *data; | |
| int affected_types; | |
| }; | |
| static void generic_cb(gboolean ok, GAtResult *result, gpointer user_data) | |
| { | |
| struct change_state_req *req = user_data; | |
| struct voicecall_data *vd = ofono_voicecall_get_data(req->vc); | |
| struct ofono_error error; | |
| decode_at_error(&error, g_at_result_final_response(result)); | |
| if (ok && req->affected_types) { | |
| GSList *l; | |
| struct ofono_call *call; | |
| for (l = vd->calls; l; l = l->next) { | |
| call = l->data; | |
| if (req->affected_types & (1 << call->status)) | |
| vd->local_release |= (1 << call->id); | |
| } | |
| } | |
| req->cb(&error, req->data); | |
| } | |
| static void gemalto_call_common(const char *cmd, struct ofono_voicecall *vc, | |
| GAtResultFunc result_cb, | |
| unsigned int affected_types, | |
| ofono_voicecall_cb_t cb, void *data) | |
| { | |
| struct voicecall_data *vd = ofono_voicecall_get_data(vc); | |
| struct change_state_req *req = g_new0(struct change_state_req, 1); | |
| req->vc = vc; | |
| req->cb = cb; | |
| req->data = data; | |
| req->affected_types = affected_types; | |
| if (g_at_chat_send(vd->chat, cmd, none_prefix, | |
| result_cb, req, g_free) > 0) | |
| return; | |
| g_free(req); | |
| CALLBACK_WITH_FAILURE(cb, data); | |
| } | |
| static void gemalto_answer(struct ofono_voicecall *vc, | |
| ofono_voicecall_cb_t cb, void *data) | |
| { | |
| gemalto_call_common("ATA", vc, generic_cb, 0, cb, data); | |
| } | |
| static void gemalto_hangup_all(struct ofono_voicecall *vc, | |
| ofono_voicecall_cb_t cb, void *data) | |
| { | |
| unsigned int affected = (1 << CALL_STATUS_INCOMING) | | |
| (1 << CALL_STATUS_DIALING) | | |
| (1 << CALL_STATUS_ALERTING) | | |
| (1 << CALL_STATUS_WAITING) | | |
| (1 << CALL_STATUS_HELD) | | |
| (1 << CALL_STATUS_ACTIVE); | |
| /* Hangup all calls */ | |
| gemalto_call_common("AT+CHUP", vc, generic_cb, affected, cb, data); | |
| } | |
| static void gemalto_hangup(struct ofono_voicecall *vc, | |
| ofono_voicecall_cb_t cb, void *data) | |
| { | |
| unsigned int affected = (1 << CALL_STATUS_ACTIVE); | |
| /* Hangup current active call */ | |
| gemalto_call_common("AT+CHLD=1", vc, generic_cb, affected, cb, data); | |
| } | |
| static void gemalto_hold_all_active(struct ofono_voicecall *vc, | |
| ofono_voicecall_cb_t cb, void *data) | |
| { | |
| unsigned int affected = (1 << CALL_STATUS_ACTIVE); | |
| gemalto_call_common("AT+CHLD=2", vc, generic_cb, affected, cb, data); | |
| } | |
| static void gemalto_release_all_held(struct ofono_voicecall *vc, | |
| ofono_voicecall_cb_t cb, void *data) | |
| { | |
| unsigned int affected = (1 << CALL_STATUS_INCOMING) | | |
| (1 << CALL_STATUS_WAITING); | |
| gemalto_call_common("AT+CHLD=0", vc, generic_cb, affected, cb, data); | |
| } | |
| static void gemalto_set_udub(struct ofono_voicecall *vc, | |
| ofono_voicecall_cb_t cb, void *data) | |
| { | |
| unsigned int affected = (1 << CALL_STATUS_INCOMING) | | |
| (1 << CALL_STATUS_WAITING); | |
| gemalto_call_common("AT+CHLD=0", vc, generic_cb, affected, cb, data); | |
| } | |
| static void gemalto_release_all_active(struct ofono_voicecall *vc, | |
| ofono_voicecall_cb_t cb, void *data) | |
| { | |
| unsigned int affected = (1 << CALL_STATUS_ACTIVE); | |
| gemalto_call_common("AT+CHLD=1", vc, generic_cb, affected, cb, data); | |
| } | |
| static void release_id_cb(gboolean ok, GAtResult *result, gpointer user_data) | |
| { | |
| struct release_id_req *req = user_data; | |
| struct voicecall_data *vd = ofono_voicecall_get_data(req->vc); | |
| struct ofono_error error; | |
| decode_at_error(&error, g_at_result_final_response(result)); | |
| if (ok) | |
| vd->local_release = 1 << req->id; | |
| req->cb(&error, req->data); | |
| } | |
| static void gemalto_release_specific(struct ofono_voicecall *vc, int id, | |
| ofono_voicecall_cb_t cb, void *data) | |
| { | |
| struct voicecall_data *vd = ofono_voicecall_get_data(vc); | |
| struct release_id_req *req = g_new0(struct release_id_req, 1); | |
| char buf[32]; | |
| req->vc = vc; | |
| req->cb = cb; | |
| req->data = data; | |
| req->id = id; | |
| snprintf(buf, sizeof(buf), "AT+CHLD=1%d", id); | |
| if (g_at_chat_send(vd->chat, buf, none_prefix, | |
| release_id_cb, req, g_free) > 0) | |
| return; | |
| g_free(req); | |
| CALLBACK_WITH_FAILURE(cb, data); | |
| } | |
| static void gemalto_private_chat(struct ofono_voicecall *vc, int id, | |
| ofono_voicecall_cb_t cb, void *data) | |
| { | |
| char buf[32]; | |
| snprintf(buf, sizeof(buf), "AT+CHLD=2%d", id); | |
| gemalto_call_common(buf, vc, generic_cb, 0, cb, data); | |
| } | |
| static void gemalto_create_multiparty(struct ofono_voicecall *vc, | |
| ofono_voicecall_cb_t cb, void *data) | |
| { | |
| gemalto_call_common("AT+CHLD=3", vc, generic_cb, 0, cb, data); | |
| } | |
| static void gemalto_transfer(struct ofono_voicecall *vc, | |
| ofono_voicecall_cb_t cb, void *data) | |
| { | |
| /* Held & Active */ | |
| unsigned int affected = (1 << CALL_STATUS_ACTIVE) | | |
| (1 << CALL_STATUS_HELD); | |
| /* Transfer can puts held & active calls together and disconnects | |
| * from both. However, some networks support transferring of | |
| * dialing/ringing calls as well. | |
| */ | |
| affected |= (1 << CALL_STATUS_DIALING) | | |
| (1 << CALL_STATUS_ALERTING); | |
| gemalto_call_common("AT+CHLD=4", vc, generic_cb, affected, cb, data); | |
| } | |
| static void gemalto_send_dtmf(struct ofono_voicecall *vc, const char *dtmf, | |
| ofono_voicecall_cb_t cb, void *data) | |
| { | |
| struct ofono_modem *modem = ofono_voicecall_get_modem(vc); | |
| int use_quotes = ofono_modem_get_integer(modem, "GemaltoVtsQuotes"); | |
| int len = strlen(dtmf); | |
| int s; | |
| int i; | |
| char *buf; | |
| /* strlen("+VTS=\"T\";") = 9 + initial AT + null */ | |
| buf = (char *)alloca(len * 9 + 3); | |
| if (use_quotes) | |
| s = sprintf(buf, "AT+VTS=\"%c\"", dtmf[0]); | |
| else | |
| s = sprintf(buf, "AT+VTS=%c", dtmf[0]); | |
| for (i = 1; i < len; i++) { | |
| if (use_quotes) | |
| s += sprintf(buf + s, ";+VTS=\"%c\"", dtmf[i]); | |
| else | |
| s += sprintf(buf + s, ";+VTS=%c", dtmf[i]); | |
| } | |
| gemalto_call_common(buf, vc, generic_cb, 0, cb, data); | |
| } | |
| static void gemalto_dial(struct ofono_voicecall *vc, | |
| const struct ofono_phone_number *ph, | |
| enum ofono_clir_option clir, | |
| ofono_voicecall_cb_t cb, void *data) | |
| { | |
| struct cb_data *cbd = cb_data_new(cb, data); | |
| char buf[256]; | |
| size_t len; | |
| cbd->user = vc; | |
| if (ph->type == 145) | |
| len = snprintf(buf, sizeof(buf), "ATD+%s", ph->number); | |
| else | |
| len = snprintf(buf, sizeof(buf), "ATD%s", ph->number); | |
| switch (clir) { | |
| case OFONO_CLIR_OPTION_INVOCATION: | |
| len += snprintf(buf+len, sizeof(buf)-len, "I"); | |
| break; | |
| case OFONO_CLIR_OPTION_SUPPRESSION: | |
| len += snprintf(buf+len, sizeof(buf)-len, "i"); | |
| break; | |
| default: | |
| break; | |
| } | |
| snprintf(buf + len, sizeof(buf) - len, ";"); | |
| gemalto_call_common(buf, vc, generic_cb, 0, cb, data); | |
| } | |
| static void gemalto_parse_slcc(GAtResult *result, GSList **l, | |
| ofono_bool_t *ret_mpty, gboolean *last) | |
| { | |
| GAtResultIter iter; | |
| int id, dir, status, type; | |
| ofono_bool_t mpty; | |
| struct ofono_call *call; | |
| const char *str = ""; | |
| int number_type = 129; | |
| if (last) | |
| *last = TRUE; | |
| g_at_result_iter_init(&iter, result); | |
| g_at_result_iter_next(&iter, "^SLCC:"); | |
| if (!g_at_result_iter_next_number(&iter, &id)) | |
| return; | |
| if (last) | |
| *last = FALSE; | |
| if (id == 0) | |
| return; | |
| if (!g_at_result_iter_next_number(&iter, &dir)) | |
| return; | |
| if (!g_at_result_iter_next_number(&iter, &status)) | |
| return; | |
| if (status > 5) | |
| return; | |
| if (!g_at_result_iter_next_number(&iter, &type)) | |
| return; | |
| if (!g_at_result_iter_next_number(&iter, &mpty)) | |
| return; | |
| /* skip 'Reserved=0' parameter, only difference from CLCC */ | |
| if (!g_at_result_iter_skip_next(&iter)) | |
| return; | |
| if (g_at_result_iter_next_string(&iter, &str)) | |
| g_at_result_iter_next_number(&iter, &number_type); | |
| call = g_new0(struct ofono_call, 1); | |
| ofono_call_init(call); | |
| call->id = id; | |
| call->direction = dir; | |
| call->status = status; | |
| call->type = type; | |
| strncpy(call->phone_number.number, str, | |
| OFONO_MAX_PHONE_NUMBER_LENGTH); | |
| call->phone_number.type = number_type; | |
| if (strlen(str) > 0) | |
| call->clip_validity = 2; | |
| else | |
| call->clip_validity = 0; | |
| *l = g_slist_insert_sorted(*l, call, at_util_call_compare); | |
| if (ret_mpty) | |
| *ret_mpty = mpty; | |
| } | |
| static void clcc_cb(gboolean ok, GAtResult *result, gpointer user_data) | |
| { | |
| struct ofono_voicecall *vc = user_data; | |
| struct voicecall_data *vd = ofono_voicecall_get_data(vc); | |
| GSList *l; | |
| if (!ok) | |
| return; | |
| vd->calls = at_util_parse_clcc(result, NULL); | |
| for (l = vd->calls; l; l = l->next) | |
| ofono_voicecall_notify(vc, l->data); | |
| } | |
| /* | |
| * ^SLCC, except for one RFU parameter (see above in the parsing), is identical | |
| * to +CLCC, but as URC it is parsed line by line, and the last line is | |
| * indicated by an empty "^SLCC:" (equivalent to the "OK" for CLCC). | |
| */ | |
| static void slcc_notify(GAtResult *result, gpointer user_data) | |
| { | |
| struct ofono_voicecall *vc = user_data; | |
| struct voicecall_data *vd = ofono_voicecall_get_data(vc); | |
| GSList *n, *o; | |
| struct ofono_call *nc, *oc; | |
| gboolean last; | |
| gemalto_parse_slcc(result, &vd->new_calls, NULL, &last); | |
| if (!last) | |
| return; | |
| n = vd->new_calls; | |
| o = vd->calls; | |
| while (n || o) { | |
| nc = n ? n->data : NULL; | |
| oc = o ? o->data : NULL; | |
| if (oc && (nc == NULL || (nc->id > oc->id))) { | |
| enum ofono_disconnect_reason reason; | |
| if (vd->local_release & (1 << oc->id)) | |
| reason = OFONO_DISCONNECT_REASON_LOCAL_HANGUP; | |
| else | |
| reason = OFONO_DISCONNECT_REASON_REMOTE_HANGUP; | |
| if (!oc->type) | |
| ofono_voicecall_disconnected(vc, oc->id, | |
| reason, NULL); | |
| o = o->next; | |
| } else if (nc && (oc == NULL || (nc->id < oc->id))) { | |
| if (nc->type == 0) /* new call, signal it */ | |
| ofono_voicecall_notify(vc, nc); | |
| n = n->next; | |
| } else { | |
| DBG("modify call part"); | |
| /* notify in case of changes */ | |
| if (memcmp(nc, oc, sizeof(*nc))) | |
| ofono_voicecall_notify(vc, nc); | |
| n = n->next; | |
| o = o->next; | |
| } | |
| } | |
| g_slist_free_full(vd->calls, g_free); | |
| vd->calls = vd->new_calls; | |
| vd->new_calls = NULL; | |
| vd->local_release = 0; | |
| } | |
| static void cssi_notify(GAtResult *result, gpointer user_data) | |
| { | |
| struct ofono_voicecall *vc = user_data; | |
| GAtResultIter iter; | |
| int code, index; | |
| g_at_result_iter_init(&iter, result); | |
| if (!g_at_result_iter_next(&iter, "+CSSI:")) | |
| return; | |
| if (!g_at_result_iter_next_number(&iter, &code)) | |
| return; | |
| if (!g_at_result_iter_next_number(&iter, &index)) | |
| index = 0; | |
| ofono_voicecall_ssn_mo_notify(vc, 0, code, index); | |
| } | |
| static void cssu_notify(GAtResult *result, gpointer user_data) | |
| { | |
| struct ofono_voicecall *vc = user_data; | |
| GAtResultIter iter; | |
| int code; | |
| int index; | |
| const char *num; | |
| struct ofono_phone_number ph; | |
| ph.number[0] = '\0'; | |
| ph.type = 129; | |
| g_at_result_iter_init(&iter, result); | |
| if (!g_at_result_iter_next(&iter, "+CSSU:")) | |
| return; | |
| if (!g_at_result_iter_next_number(&iter, &code)) | |
| return; | |
| if (!g_at_result_iter_next_number_default(&iter, -1, &index)) | |
| goto out; | |
| if (!g_at_result_iter_next_string(&iter, &num)) | |
| goto out; | |
| strncpy(ph.number, num, OFONO_MAX_PHONE_NUMBER_LENGTH); | |
| if (!g_at_result_iter_next_number(&iter, &ph.type)) | |
| return; | |
| out: | |
| ofono_voicecall_ssn_mt_notify(vc, 0, code, index, &ph); | |
| } | |
| static void gemalto_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("voicecall_init: registering to notifications"); | |
| /* NO CARRIER, NO ANSWER, BUSY, NO DIALTONE are handled through SLCC */ | |
| g_at_chat_register(vd->chat, "^SLCC:", slcc_notify, FALSE, vc, NULL); | |
| g_at_chat_register(vd->chat, "+CSSI:", cssi_notify, FALSE, vc, NULL); | |
| g_at_chat_register(vd->chat, "+CSSU:", cssu_notify, FALSE, vc, NULL); | |
| ofono_voicecall_register(vc); | |
| /* Populate the call list */ | |
| g_at_chat_send(vd->chat, "AT+CLCC", clcc_prefix, clcc_cb, vc, NULL); | |
| } | |
| static int gemalto_voicecall_probe(struct ofono_voicecall *vc, | |
| unsigned int vendor, void *data) | |
| { | |
| GAtChat *chat = data; | |
| struct voicecall_data *vd; | |
| vd = g_new0(struct voicecall_data, 1); | |
| vd->chat = g_at_chat_clone(chat); | |
| ofono_voicecall_set_data(vc, vd); | |
| g_at_chat_send(vd->chat, "AT+CSSN=1,1", NULL, NULL, NULL, NULL); | |
| g_at_chat_send(vd->chat, "AT^SLCC=1", NULL, | |
| gemalto_voicecall_initialized, vc, NULL); | |
| return 0; | |
| } | |
| static void gemalto_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 const struct ofono_voicecall_driver driver = { | |
| .name = "gemaltomodem", | |
| .probe = gemalto_voicecall_probe, | |
| .remove = gemalto_voicecall_remove, | |
| .dial = gemalto_dial, | |
| .answer = gemalto_answer, | |
| .hangup_all = gemalto_hangup_all, | |
| .hangup_active = gemalto_hangup, | |
| .hold_all_active = gemalto_hold_all_active, | |
| .release_all_held = gemalto_release_all_held, | |
| .set_udub = gemalto_set_udub, | |
| .release_all_active = gemalto_release_all_active, | |
| .release_specific = gemalto_release_specific, | |
| .private_chat = gemalto_private_chat, | |
| .create_multiparty = gemalto_create_multiparty, | |
| .transfer = gemalto_transfer, | |
| .send_tones = gemalto_send_dtmf | |
| }; | |
| void gemalto_voicecall_init(void) | |
| { | |
| ofono_voicecall_driver_register(&driver); | |
| } | |
| void gemalto_voicecall_exit(void) | |
| { | |
| ofono_voicecall_driver_unregister(&driver); | |
| } |