---
 plugins/hfp_ag.c |  153 +++++++++++++++++++++++++++++++++++++++++++++++++++++-
 1 file changed, 152 insertions(+), 1 deletion(-)

diff --git a/plugins/hfp_ag.c b/plugins/hfp_ag.c
index 2652f3f..342f959 100644
--- a/plugins/hfp_ag.c
+++ b/plugins/hfp_ag.c
@@ -37,7 +37,8 @@
 
 #define AGENT_PATH "/hfp_ag"
 #define VERSION_1_5 0x0105
-#define FEATURES       (HFP_AG_FEATURE_3WAY | HFP_AG_FEATURE_REJECT_CALL | \
+#define FEATURES       (HFP_AG_FEATURE_3WAY | HFP_AG_FEATURE_ECNR | \
+                       HFP_AG_FEATURE_REJECT_CALL | \
                        HFP_AG_FEATURE_ENHANCED_CALL_STATUS | \
                        HFP_AG_FEATURE_ENHANCED_CALL_CONTROL | \
                        HFP_AG_FEATURE_EXTENDED_RES_CODE)
@@ -46,10 +47,150 @@
 #define DBUS_TYPE_UNIX_FD -1
 #endif
 
+struct bt_audio {
+       struct ofono_emulator *em;
+       char *path;
+       guint16 r_features;
+       DBusPendingCall *call;
+};
+
 static guint modemwatch_id;
 static GList *modems;
 static GHashTable *sim_hash = NULL;
 
+static void audio_transport_set_property_cb(DBusPendingCall *call,
+                                               gpointer user_data)
+{
+       struct bt_audio *audio = user_data;
+       DBusMessage *reply;
+       struct DBusError derr;
+       struct ofono_error result;
+
+       reply = dbus_pending_call_steal_reply(call);
+
+       dbus_error_init(&derr);
+
+       if (dbus_set_error_from_message(&derr, reply)) {
+               ofono_error("MediaTransport.SetProperties replied an error: " \
+                               "%s, %s", derr.name, derr.message);
+               dbus_error_free(&derr);
+               result.type = OFONO_ERROR_TYPE_FAILURE;
+       } else
+               result.type = OFONO_ERROR_TYPE_NO_ERROR;
+
+       result.error = 0;
+       ofono_emulator_send_final(audio->em, &result);
+
+       dbus_message_unref(reply);
+
+       dbus_pending_call_unref(audio->call);
+       audio->call = NULL;
+}
+
+static void audio_transport_set_property(struct bt_audio *audio,
+                               const char *name, int type, const void *value)
+{
+       DBusMessage *msg;
+       DBusMessageIter iter, var;
+       const char *str_type;
+       DBusConnection *connection;
+       struct ofono_error result;
+
+       if (audio->call != NULL)
+               goto fail;
+
+       if (audio->path == NULL)
+               goto fail;
+
+       switch (type) {
+       case DBUS_TYPE_BOOLEAN:
+               str_type = DBUS_TYPE_BOOLEAN_AS_STRING;
+               break;
+
+       case DBUS_TYPE_UINT16:
+               str_type = DBUS_TYPE_UINT16_AS_STRING;
+               break;
+
+       default:
+               goto fail;
+       }
+
+       msg = dbus_message_new_method_call(BLUEZ_SERVICE, audio->path,
+                               BLUEZ_TRANSPORT_INTERFACE, "SetProperty");
+       if (msg == NULL)
+               goto fail;
+
+       dbus_message_iter_init_append(msg, &iter);
+       dbus_message_iter_append_basic(&iter, DBUS_TYPE_STRING, &name);
+
+       dbus_message_iter_open_container(&iter, DBUS_TYPE_VARIANT, str_type,
+                                               &var);
+       dbus_message_iter_append_basic(&var, type, value);
+       dbus_message_iter_close_container(&iter, &var);
+
+       connection = ofono_dbus_get_connection();
+
+       if (!dbus_connection_send_with_reply(connection, msg, &audio->call,
+                                                                       -1)) {
+               ofono_error("Sending SetProperty failed");
+               dbus_message_unref(msg);
+               goto fail;
+       }
+
+       dbus_pending_call_set_notify(audio->call,
+                                               audio_transport_set_property_cb,
+                                               audio, NULL);
+
+       dbus_message_unref(msg);
+       return;
+
+fail:
+       result.error = 0;
+       result.type = OFONO_ERROR_TYPE_FAILURE;
+       ofono_emulator_send_final(audio->em, &result);
+}
+
+static void emulator_nrec_cb(struct ofono_emulator *em,
+                       struct ofono_emulator_request *req, void *userdata)
+{
+       struct bt_audio *audio = userdata;
+       struct ofono_error result;
+       int val;
+
+       switch (ofono_emulator_request_get_type(req)) {
+       case OFONO_EMULATOR_REQUEST_TYPE_SET:
+               if (!ofono_emulator_request_next_number(req, &val))
+                       goto fail;
+
+               if (val != 0 && val != 1)
+                       goto fail;
+
+               audio_transport_set_property(audio, "NREC", DBUS_TYPE_BOOLEAN,
+                                                                       &val);
+               break;
+
+       default:
+fail:
+               result.error = 0;
+               result.type = OFONO_ERROR_TYPE_FAILURE;
+               ofono_emulator_send_final(em, &result);
+       };
+}
+
+static void free_audio_management(struct bt_audio *audio)
+{
+       DBG("");
+
+       if (audio == NULL)
+               return;
+
+       if (audio->call)
+               dbus_pending_call_cancel(audio->call);
+
+       g_free(audio->path);
+       g_free(audio);
+}
+
 static DBusMessage *hfp_ag_agent_new_connection(DBusConnection *conn,
                                                DBusMessage *msg, void *data)
 {
@@ -60,6 +201,7 @@ static DBusMessage 
*hfp_ag_agent_new_connection(DBusConnection *conn,
        guint16 features = 0;
        struct ofono_emulator *em;
        struct ofono_modem *modem;
+       struct bt_audio *audio;
 
        fd = bluetooth_parse_newconnection_message(msg, &device, &version,
                                                        &features, &path);
@@ -83,6 +225,15 @@ static DBusMessage 
*hfp_ag_agent_new_connection(DBusConnection *conn,
 
        ofono_emulator_register(em, fd);
 
+       audio = g_new0(struct bt_audio, 1);
+       audio->em = em;
+       audio->path = g_strdup(path);
+       audio->r_features = features;
+       ofono_emulator_set_data(em, audio,
+                               (ofono_destroy_func)free_audio_management);
+
+       ofono_emulator_add_handler(em, "+NREC", emulator_nrec_cb, audio, NULL);
+
        return dbus_message_new_method_return(msg);
 }
 
-- 
1.7.9.5

_______________________________________________
ofono mailing list
ofono@ofono.org
http://lists.ofono.org/listinfo/ofono

Reply via email to