Add voicecall driver for Bluetooth HFP

HFP voicecall driver uses AT+CIEV indicator to notify call status
update according to Bluetooth HFP spec v1.5. This patch only adds single
call support.
This commit is contained in:
Zhenhua Zhang 2009-10-28 19:01:24 +08:00 committed by Denis Kenzior
parent 57aaf9813f
commit 4a36fc7c82
5 changed files with 617 additions and 2 deletions

View File

@ -125,7 +125,8 @@ builtin_sources += drivers/atmodem/atutil.h \
builtin_modules += hfpmodem
builtin_sources += drivers/atmodem/atutil.h \
drivers/hfpmodem/hfpmodem.h \
drivers/hfpmodem/hfpmodem.c
drivers/hfpmodem/hfpmodem.c \
drivers/hfpmodem/voicecall.c
builtin_modules += mbmmodem
builtin_sources += drivers/atmodem/atutil.h \

View File

@ -41,11 +41,14 @@
static int hfpmodem_init(void)
{
hfp_voicecall_init();
return 0;
}
static void hfpmodem_exit(void)
{
hfp_voicecall_exit();
}
OFONO_PLUGIN_DEFINE(hfpmodem, "Hands-Free Profile Driver", VERSION,

View File

@ -0,0 +1,608 @@
/*
*
* oFono - Open Source Telephony
*
* Copyright (C) 2008-2009 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
#define _GNU_SOURCE
#include <string.h>
#include <stdlib.h>
#include <stdio.h>
#include <glib.h>
#include <ofono/log.h>
#include <ofono/modem.h>
#include <ofono/voicecall.h>
#include <common.h>
#include "gatchat.h"
#include "gatresult.h"
#include "hfpmodem.h"
#define AG_CHLD_0 0x01
#define AG_CHLD_1 0x02
#define AG_CHLD_1x 0x04
#define AG_CHLD_2 0x08
#define AG_CHLD_2x 0x10
#define AG_CHLD_3 0x20
#define AG_CHLD_4 0x40
static const char *none_prefix[] = { NULL };
static const char *chld_prefix[] = { "+CHLD:", NULL };
struct voicecall_data {
GAtChat *chat;
GSList *calls;
struct ofono_call *call;
gboolean mpty_call;
unsigned int ag_features;
unsigned int ag_mpty_features;
unsigned char cind_pos[HFP_INDICATOR_LAST];
int cind_val[HFP_INDICATOR_LAST];
unsigned int id_list;
unsigned int local_release;
};
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 struct ofono_call *create_call(struct voicecall_data *d, int type,
int direction, int status,
const char *num, int num_type, int clip)
{
struct ofono_call *call;
/* Generate a call structure for the waiting call */
call = g_try_new0(struct ofono_call, 1);
if (!call)
return NULL;
call->id = at_util_alloc_next_id(&d->id_list);
call->type = type;
call->direction = direction;
call->status = status;
if (clip != 2) {
strncpy(call->phone_number.number, num,
OFONO_MAX_PHONE_NUMBER_LENGTH);
call->phone_number.type = num_type;
}
d->calls = g_slist_insert_sorted(d->calls, call, at_util_call_compare);
call->clip_validity = clip;
if (d->call)
d->mpty_call = TRUE;
d->call = call;
return call;
}
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;
dump_response("generic_cb", ok, result);
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 & (0x1 << call->status))
vd->local_release |=
(0x1 << call->id);
}
}
req->cb(&error, req->data);
}
static void atd_cb(gboolean ok, GAtResult *result, gpointer user_data)
{
struct cb_data *cbd = user_data;
struct ofono_voicecall *vc = cbd->user;
struct voicecall_data *vd = ofono_voicecall_get_data(vc);
ofono_voicecall_cb_t cb = cbd->cb;
GAtResultIter iter;
int type = 128;
int validity = 2;
struct ofono_error error;
struct ofono_call *call;
dump_response("atd_cb", ok, result);
decode_at_error(&error, g_at_result_final_response(result));
if (!ok)
goto out;
g_at_result_iter_init(&iter, result);
call = create_call(vd, 0, 0, CALL_STATUS_DIALING, NULL, type, validity);
if (!call) {
ofono_error("Unable to allocate call, "
"call tracking will fail!");
return;
}
out:
cb(&error, cbd->data);
}
static void hfp_dial(struct ofono_voicecall *vc,
const struct ofono_phone_number *ph,
enum ofono_clir_option clir, enum ofono_cug_option cug,
ofono_voicecall_cb_t cb, void *data)
{
struct voicecall_data *vd = ofono_voicecall_get_data(vc);
struct cb_data *cbd = cb_data_new(cb, data);
char buf[256];
if (!cbd)
goto error;
cbd->user = vc;
if (ph->type == 145)
sprintf(buf, "ATD+%s", ph->number);
else
sprintf(buf, "ATD%s", ph->number);
if ((clir != OFONO_CLIR_OPTION_DEFAULT) ||
(cug != OFONO_CUG_OPTION_DEFAULT))
goto error;
strcat(buf, ";");
if (g_at_chat_send(vd->chat, buf, none_prefix,
atd_cb, cbd, g_free) > 0)
return;
error:
if (cbd)
g_free(cbd);
CALLBACK_WITH_FAILURE(cb, data);
}
static void hfp_template(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_try_new0(struct change_state_req, 1);
if (!req)
goto error;
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;
error:
if (req)
g_free(req);
CALLBACK_WITH_FAILURE(cb, data);
}
static void hfp_answer(struct ofono_voicecall *vc,
ofono_voicecall_cb_t cb, void *data)
{
hfp_template("ATA", vc, generic_cb, 0, cb, data);
}
static void hfp_hangup(struct ofono_voicecall *vc,
ofono_voicecall_cb_t cb, void *data)
{
/* Hangup all calls */
hfp_template("AT+CHUP", vc, generic_cb, 0x3f, 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;
dump_response("release_id_cb", ok, result);
decode_at_error(&error, g_at_result_final_response(result));
if (ok)
vd->local_release = 0x1 << req->id;
req->cb(&error, req->data);
}
static void hfp_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_try_new0(struct release_id_req, 1);
if (!req)
goto error;
req->vc = vc;
req->cb = cb;
req->data = data;
req->id = id;
if (vd->mpty_call == FALSE)
g_at_chat_send(vd->chat, "AT+CHUP", none_prefix,
release_id_cb, req, g_free);
return;
error:
if (req)
g_free(req);
CALLBACK_WITH_FAILURE(cb, data);
}
static void ring_notify(GAtResult *result, gpointer user_data)
{
struct ofono_voicecall *vc = user_data;
struct voicecall_data *vd = ofono_voicecall_get_data(vc);
struct ofono_call *call;
dump_response("ring_notify", TRUE, result);
/* RING can repeat, ignore if we already have an incoming call */
if (g_slist_find_custom(vd->calls,
GINT_TO_POINTER(CALL_STATUS_INCOMING),
at_util_call_compare_by_status))
return;
/* ignore if we already have a waiting call */
if (g_slist_find_custom(vd->calls,
GINT_TO_POINTER(CALL_STATUS_WAITING),
at_util_call_compare_by_status))
return;
/* Generate an incoming call of voice type */
call = create_call(vd, 0, 1, CALL_STATUS_INCOMING, NULL, 128, 2);
if (!call) {
ofono_error("Couldn't create call, call management is fubar!");
return;
}
}
static void clip_notify(GAtResult *result, gpointer user_data)
{
struct ofono_voicecall *vc = user_data;
struct voicecall_data *vd = ofono_voicecall_get_data(vc);
GAtResultIter iter;
const char *num;
int type, validity;
GSList *l;
struct ofono_call *call;
dump_response("clip_notify", TRUE, result);
l = g_slist_find_custom(vd->calls,
GINT_TO_POINTER(CALL_STATUS_INCOMING),
at_util_call_compare_by_status);
if (l == NULL) {
ofono_error("CLIP for unknown call");
return;
}
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, alpha and validity */
g_at_result_iter_skip_next(&iter);
g_at_result_iter_skip_next(&iter);
g_at_result_iter_skip_next(&iter);
g_at_result_iter_skip_next(&iter);
ofono_debug("clip_notify: %s %d %d", num, type, validity);
call = l->data;
strncpy(call->phone_number.number, num,
OFONO_MAX_PHONE_NUMBER_LENGTH);
call->phone_number.number[OFONO_MAX_PHONE_NUMBER_LENGTH] = '\0';
call->phone_number.type = type;
call->clip_validity = validity;
ofono_voicecall_notify(vc, call);
}
static void release_call(struct ofono_voicecall *vc, struct ofono_call *call)
{
struct voicecall_data *vd = ofono_voicecall_get_data(vc);
enum ofono_disconnect_reason reason;
if (call == NULL)
return;
if (vd->local_release & (0x1 << call->id))
reason = OFONO_DISCONNECT_REASON_LOCAL_HANGUP;
else
reason = OFONO_DISCONNECT_REASON_REMOTE_HANGUP;
ofono_voicecall_disconnected(vc, call->id, reason, NULL);
at_util_release_id(&vd->id_list, call->id);
if (vd->mpty_call == FALSE)
vd->local_release = 0;
vd->calls = g_slist_remove(vd->calls, call);
if (call == vd->call)
vd->call = NULL;
g_free(call);
call = NULL;
}
static void ciev_call_notify(struct ofono_voicecall *vc,
struct ofono_call *call,
unsigned int call_pos, unsigned int value)
{
struct voicecall_data *vd = ofono_voicecall_get_data(vc);
if (vd->mpty_call == FALSE) {
switch (value) {
case 0:
release_call(vc, call);
break;
case 1:
call->status = CALL_STATUS_ACTIVE;
ofono_voicecall_notify(vc, call);
break;
default:
break;
}
}
vd->cind_val[call_pos] = value;
}
static void ciev_callsetup_notify(struct ofono_voicecall *vc,
struct ofono_call *call,
unsigned int callsetup_pos, unsigned int value)
{
struct voicecall_data *vd = ofono_voicecall_get_data(vc);
int call_pos = vd->cind_pos[HFP_INDICATOR_CALL];
if (vd->mpty_call == FALSE) {
switch (value) {
case 0:
/* call=0 and callsetup=1: reject an incoming call
* call=0 and callsetup=2,3: interrupt an outgoing call
*/
if ((vd->cind_val[call_pos] == 0) &&
(vd->cind_val[callsetup_pos] > 0))
release_call(vc, call);
break;
case 1:
case 2:
break;
case 3:
call->status = CALL_STATUS_ALERTING;
ofono_voicecall_notify(vc, call);
default:
break;
}
}
vd->cind_val[callsetup_pos] = value;
}
static void ciev_notify(GAtResult *result, gpointer user_data)
{
struct ofono_voicecall *vc = user_data;
struct voicecall_data *vd = ofono_voicecall_get_data(vc);
struct ofono_call *call = vd->call;
int index;
int value;
GAtResultIter iter;
g_at_result_iter_init(&iter, result);
if (!g_at_result_iter_next(&iter, "+CIEV:"))
return;
if (!g_at_result_iter_next_number(&iter, &index))
return;
if (!g_at_result_iter_next_number(&iter, &value))
return;
if (index == vd->cind_pos[HFP_INDICATOR_CALL])
ciev_call_notify(vc, call, index, value);
else if (index == vd->cind_pos[HFP_INDICATOR_CALLSETUP])
ciev_callsetup_notify(vc, call, index, value);
return;
}
static void chld_cb(gboolean ok, GAtResult *result, gpointer user_data)
{
struct voicecall_data *vd = user_data;
unsigned int ag_mpty_feature = 0;
GAtResultIter iter;
const char *str;
if (!ok)
goto error;
g_at_result_iter_init(&iter, result);
if (!g_at_result_iter_next(&iter, "+CHLD:"))
goto error;
if (!g_at_result_iter_open_list(&iter))
goto error;
while (g_at_result_iter_next_unquoted_string(&iter, &str)) {
if (!strcmp(str, "0"))
ag_mpty_feature |= AG_CHLD_0;
else if (!strcmp(str, "1"))
ag_mpty_feature |= AG_CHLD_1;
else if (!strcmp(str, "1x"))
ag_mpty_feature |= AG_CHLD_1x;
else if (!strcmp(str, "2"))
ag_mpty_feature |= AG_CHLD_2;
else if (!strcmp(str, "2x"))
ag_mpty_feature |= AG_CHLD_2x;
else if (!strcmp(str, "3"))
ag_mpty_feature |= AG_CHLD_3;
else if (!strcmp(str, "4"))
ag_mpty_feature |= AG_CHLD_4;
}
if (!g_at_result_iter_close_list(&iter))
goto error;
vd->ag_mpty_features = ag_mpty_feature;
return;
error:
return;
}
static void hfp_voicecall_initialized(gboolean ok, GAtResult *result,
gpointer user_data)
{
struct ofono_voicecall *vc = user_data;
struct voicecall_data *vd = ofono_voicecall_get_data(vc);
ofono_debug("hfp_voicecall_init: registering to notifications");
g_at_chat_register(vd->chat, "RING", ring_notify, FALSE, vc, NULL);
g_at_chat_register(vd->chat, "+CLIP:", clip_notify, FALSE, vc, NULL);
g_at_chat_register(vd->chat, "+CIEV:", ciev_notify, FALSE, vc, NULL);
ofono_voicecall_register(vc);
}
static int hfp_voicecall_probe(struct ofono_voicecall *vc, unsigned int vendor,
gpointer user_data)
{
struct hfp_data *data = user_data;
struct voicecall_data *vd;
vd = g_new0(struct voicecall_data, 1);
vd->chat = data->chat;
vd->ag_features = data->ag_features;
vd->call = NULL;
vd->mpty_call = FALSE;
memcpy(vd->cind_pos, data->cind_pos, HFP_INDICATOR_LAST);
memcpy(vd->cind_val, data->cind_val, HFP_INDICATOR_LAST);
if (vd->ag_features & AG_FEATURE_3WAY)
g_at_chat_send(vd->chat, "AT+CHLD=?", chld_prefix,
chld_cb, vd, NULL);
ofono_voicecall_set_data(vc, vd);
g_at_chat_send(vd->chat, "AT+CLIP=1", NULL, NULL, NULL, NULL);
g_at_chat_send(vd->chat, "AT+CCWA=1", NULL,
hfp_voicecall_initialized, vc, NULL);
return 0;
}
static void hfp_voicecall_remove(struct ofono_voicecall *vc)
{
struct voicecall_data *vd = ofono_voicecall_get_data(vc);
g_slist_foreach(vd->calls, (GFunc) g_free, NULL);
g_slist_free(vd->calls);
g_free(vd);
}
static struct ofono_voicecall_driver driver = {
.name = "hfpmodem",
.probe = hfp_voicecall_probe,
.remove = hfp_voicecall_remove,
.dial = hfp_dial,
.answer = hfp_answer,
.hangup = hfp_hangup,
.list_calls = NULL,
.hold_all_active = NULL,
.release_all_held = NULL,
.set_udub = NULL,
.release_all_active = NULL,
.release_specific = hfp_release_specific,
.private_chat = NULL,
.create_multiparty = NULL,
.transfer = NULL,
.deflect = NULL,
.swap_without_accept = NULL,
.send_tones = NULL
};
void hfp_voicecall_init()
{
ofono_voicecall_driver_register(&driver);
}
void hfp_voicecall_exit()
{
ofono_voicecall_driver_unregister(&driver);
}

View File

@ -307,7 +307,10 @@ static int hfp_disable(struct ofono_modem *modem)
static void hfp_pre_sim(struct ofono_modem *modem)
{
struct hfp_data *data = ofono_modem_get_data(modem);
DBG("%p", modem);
ofono_voicecall_create(modem, 0, "hfpmodem", data);
}
static void hfp_post_sim(struct ofono_modem *modem)

View File

@ -80,7 +80,7 @@ if __name__ == "__main__":
call.connect_to_signal("PropertyChanged", voicecall_property_changed)
gobject.timeout_add(5000, hangup_all)
gobject.timeout_add(10000, hangup_all)
mainloop = gobject.MainLoop()
mainloop.run()