From 4d49d0879f609e3b6ee6e45837607e2593313750 Mon Sep 17 00:00:00 2001
From: Marcel Holtmann <marcel@holtmann.org>
Date: Wed, 29 Sep 2010 07:41:01 +0900
Subject: 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.
---
 plugins/ifx.c | 60 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++-
 1 file changed, 59 insertions(+), 1 deletion(-)

(limited to 'plugins/ifx.c')

diff --git a/plugins/ifx.c b/plugins/ifx.c
index 311de34a..edfe9f0b 100644
--- a/plugins/ifx.c
+++ b/plugins/ifx.c
@@ -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);
-- 
cgit v1.2.3