[PATCH 6/6] adapter: Implement adapter enable and disable commands

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



This allows HAL to enable and disable adapter.
---
 android/adapter.c | 64 ++++++++++++++++++++++++++++++++++++++++++++++++++++++-
 1 file changed, 63 insertions(+), 1 deletion(-)

diff --git a/android/adapter.c b/android/adapter.c
index 5621e67..1a3e3f4 100644
--- a/android/adapter.c
+++ b/android/adapter.c
@@ -290,12 +290,74 @@ bool bt_adapter_init(uint16_t index, struct mgmt *mgmt_if,
 	return adapter;
 }
 
+static void set_mode_complete(uint8_t status, uint16_t length,
+					const void *param, void *user_data)
+{
+	if (status != MGMT_STATUS_SUCCESS) {
+		error("Failed to set mode: %s (0x%02x)",
+						mgmt_errstr(status), status);
+		return;
+	}
+
+	/*
+	 * The parameters are identical and also the task that is
+	 * required in both cases. So it is safe to just call the
+	 * event handling functions here.
+	 */
+	new_settings_callback(default_adapter->index, length, param,
+							default_adapter);
+}
+
+static bool set_mode(uint16_t opcode, uint8_t mode)
+{
+	struct mgmt_mode cp;
+
+	memset(&cp, 0, sizeof(cp));
+	cp.val = mode;
+
+	DBG("opcode=0x%x mode=0x%x", opcode, mode);
+
+	if (mgmt_send(default_adapter->mgmt, opcode, default_adapter->index,
+			sizeof(cp), &cp, set_mode_complete, NULL, NULL) > 0)
+		return true;
+
+	error("Failed to set mode");
+
+	return false;
+}
+
 void bt_adapter_handle_cmd(GIOChannel *io, uint8_t opcode, void *buf,
 								uint16_t len)
 {
+	uint8_t status = HAL_ERROR_FAILED;
+
 	switch (opcode) {
+	case HAL_MSG_OP_BT_ENABLE:
+		if (default_adapter->current_settings & MGMT_SETTING_POWERED) {
+			status = HAL_ERROR_DONE;
+			break;
+		}
+
+		if (set_mode(MGMT_OP_SET_POWERED, 0x01)) {
+			ipc_send(io, HAL_SERVICE_ID_CORE, opcode, 0, NULL, -1);
+			return;
+		}
+		break;
+	case HAL_MSG_OP_BT_DISABLE:
+		if (!(default_adapter->current_settings & MGMT_SETTING_POWERED)) {
+			status = HAL_ERROR_DONE;
+			break;
+		}
+
+		if (set_mode(MGMT_OP_SET_POWERED, 0x00)) {
+			ipc_send(io, HAL_SERVICE_ID_CORE, opcode, 0, NULL, -1);
+			return;
+		}
+		break;
 	default:
-		ipc_send_error(io, HAL_SERVICE_ID_BLUETOOTH, HAL_ERROR_FAILED);
+		DBG("Unhandled command, opcode 0x%x", opcode);
 		break;
 	}
+
+	ipc_send_error(io, HAL_SERVICE_ID_BLUETOOTH, status);
 }
-- 
1.8.4

--
To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at  http://vger.kernel.org/majordomo-info.html




[Index of Archives]     [Bluez Devel]     [Linux Wireless Networking]     [Linux Wireless Personal Area Networking]     [Linux ATH6KL]     [Linux USB Devel]     [Linux Media Drivers]     [Linux Audio Users]     [Linux Kernel]     [Linux SCSI]     [Big List of Linux Books]

  Powered by Linux