ifx: Add support for audio configuration of modem

For the XMM6260 Infineon modem it is possible to use different audio
configuration depending on your platform. Currently the setup of
FULL_DUPLEX, BURSTMODE_48KHZ and BURSTMODE_96KHZ are supported. If
appropiate values for OFONO_IFX_MODEL and OFONO_IFX_AUDIO are set
in the udev rules file, then the audio configuration will be changed
when bringing up the modem.
This commit is contained in:
Marcel Holtmann 2010-09-29 07:41:01 +09:00
parent 5d1b9d5925
commit 4d49d0879f
1 changed files with 59 additions and 1 deletions

View File

@ -74,6 +74,7 @@ static const char *dlc_nodes[NUM_DLC] = { "/dev/ttyGSM1", "/dev/ttyGSM2",
"/dev/ttyGSM7", "/dev/ttyGSM8" };
static const char *none_prefix[] = { NULL };
static const char *xdrv_prefix[] = { "+XDRV:", NULL };
struct ifx_data {
GIOChannel *device;
@ -84,6 +85,11 @@ struct ifx_data {
guint frame_size;
int mux_ldisc;
int saved_ldisc;
int audio_source;
int audio_dest;
int audio_context;
const char *audio_setting;
int audio_loopback;
struct ofono_sim *sim;
gboolean have_sim;
};
@ -232,6 +238,7 @@ static void cfun_enable(gboolean ok, GAtResult *result, gpointer user_data)
{
struct ofono_modem *modem = user_data;
struct ifx_data *data = ofono_modem_get_data(modem);
char buf[64];
DBG("");
@ -242,6 +249,38 @@ static void cfun_enable(gboolean ok, GAtResult *result, gpointer user_data)
return;
}
if (data->audio_setting && data->audio_source && data->audio_dest) {
/* configure source */
snprintf(buf, sizeof(buf), "AT+XDRV=40,4,%d,%d,%s",
data->audio_source,
data->audio_context,
data->audio_setting);
g_at_chat_send(data->dlcs[AUX_DLC], buf, xdrv_prefix,
NULL, NULL, NULL);
/* configure destination */
snprintf(buf, sizeof(buf), "AT+XDRV=40,5,%d,%d,%s",
data->audio_dest,
data->audio_context,
data->audio_setting);
g_at_chat_send(data->dlcs[AUX_DLC], buf, xdrv_prefix,
NULL, NULL, NULL);
if (data->audio_loopback) {
/* set destination for source */
snprintf(buf, sizeof(buf), "AT+XDRV=40,6,%d,%d",
data->audio_source, data->audio_dest);
g_at_chat_send(data->dlcs[AUX_DLC], buf, xdrv_prefix,
NULL, NULL, NULL);
/* enable source */
snprintf(buf, sizeof(buf), "AT+XDRV=40,2,%d",
data->audio_source);
g_at_chat_send(data->dlcs[AUX_DLC], buf, xdrv_prefix,
NULL, NULL, NULL);
}
}
data->have_sim = FALSE;
/* notify that the modem is ready so that pre_sim gets called */
@ -395,7 +434,7 @@ error:
static int ifx_enable(struct ofono_modem *modem)
{
struct ifx_data *data = ofono_modem_get_data(modem);
const char *device, *ldisc;
const char *device, *ldisc, *model, *audio, *loopback;
GAtSyntax *syntax;
GAtChat *chat;
@ -407,6 +446,25 @@ static int ifx_enable(struct ofono_modem *modem)
DBG("%s", device);
model = ofono_modem_get_string(modem, "Model");
if (g_strcmp0(model, "XMM6260") == 0) {
data->audio_source = 4;
data->audio_dest = 3;
data->audio_context = 0;
}
audio = ofono_modem_get_string(modem, "AudioSetting");
if (g_strcmp0(audio, "FULL_DUPLEX") == 0)
data->audio_setting = "0,0,0,0,0,0,0,0,0";
else if (g_strcmp0(audio, "BURSTMODE_48KHZ") == 0)
data->audio_setting = "0,0,8,0,2,0,0,0,0";
else if (g_strcmp0(audio, "BURSTMODE_96KHZ") == 0)
data->audio_setting = "0,0,9,0,2,0,0,0,0";
loopback = ofono_modem_get_string(modem, "AudioLoopback");
if (loopback != NULL)
data->audio_loopback = atoi(loopback);
ldisc = ofono_modem_get_string(modem, "LineDiscipline");
if (ldisc != NULL) {
data->mux_ldisc = atoi(ldisc);