From ded70b727e6f5f182b6d5802f8e4a54534f5392e Mon Sep 17 00:00:00 2001
From: Andrei Emeltchenko <andrei.emeltchenko@intel.com>
Date: Wed, 26 Feb 2014 16:32:14 +0200
Subject: [PATCH] android/avrcp: Add avrcp_get_capabilities request

Implement avrcp_get_capabilities() request through
avrcp_send_vendordep_req(). avctp_send_req() is not exported so we use
the functions which are exported by AVCTP code.
---
 android/avrcp-lib.c | 67 +++++++++++++++++++++++++++++++++++++++++++++
 android/avrcp-lib.h |  3 ++
 android/avrcp.c     |  1 +
 3 files changed, 71 insertions(+)

diff --git a/android/avrcp-lib.c b/android/avrcp-lib.c
index d46e3d3f6..e620af546 100644
--- a/android/avrcp-lib.c
+++ b/android/avrcp-lib.c
@@ -27,6 +27,7 @@
 
 #include <stdbool.h>
 #include <glib.h>
+#include <errno.h>
 
 #include "lib/bluetooth.h"
 
@@ -50,6 +51,16 @@
 #define AVRCP_STATUS_NO_AVAILABLE_PLAYERS	0x15
 #define AVRCP_STATUS_ADDRESSED_PLAYER_CHANGED	0x16
 
+/* Packet types */
+#define AVRCP_PACKET_TYPE_SINGLE		0x00
+#define AVRCP_PACKET_TYPE_START			0x01
+#define AVRCP_PACKET_TYPE_CONTINUING		0x02
+#define AVRCP_PACKET_TYPE_END			0x03
+
+/* Capabilities for AVRCP_GET_CAPABILITIES pdu */
+#define CAP_COMPANY_ID				0x02
+#define CAP_EVENTS_SUPPORTED			0x03
+
 #if __BYTE_ORDER == __LITTLE_ENDIAN
 
 struct avrcp_header {
@@ -67,6 +78,13 @@ static inline uint32_t ntoh24(const uint8_t src[3])
 	return src[0] << 16 | src[1] << 8 | src[2];
 }
 
+static inline void hton24(uint8_t dst[3], uint32_t src)
+{
+	dst[0] = (src >> 16) & 0xff;
+	dst[1] = (src >> 8) & 0xff;
+	dst[2] = src & 0xff;
+}
+
 #elif __BYTE_ORDER == __BIG_ENDIAN
 
 struct avrcp_header {
@@ -88,6 +106,11 @@ static inline uint32_t ntoh24(const uint8_t src[3])
 	return dst;
 }
 
+static inline void hton24(uint8_t dst[3], uint32_t src)
+{
+	memcpy(&dst, src, sizeof(dst));
+}
+
 #else
 #error "Unknown byte order"
 #endif
@@ -95,6 +118,9 @@ static inline uint32_t ntoh24(const uint8_t src[3])
 struct avrcp {
 	struct avctp *conn;
 
+	size_t tx_mtu;
+	uint8_t *tx_buf;
+
 	const struct avrcp_control_handler *control_handlers;
 	void *control_data;
 	unsigned int control_id;
@@ -212,6 +238,9 @@ struct avrcp *avrcp_new(int fd, size_t imtu, size_t omtu, uint16_t version)
 		return NULL;
 	}
 
+	session->tx_mtu = omtu;
+	session->tx_buf = g_malloc(omtu);
+
 	session->passthrough_id = avctp_register_passthrough_handler(
 							session->conn,
 							handle_passthrough_pdu,
@@ -251,3 +280,41 @@ int avrcp_init_uinput(struct avrcp *session, const char *name,
 {
 	return avctp_init_uinput(session->conn, name, address);
 }
+
+static int avrcp_send_req(struct avrcp *session, uint8_t code, uint8_t subunit,
+					uint8_t pdu_id, uint8_t *params,
+					size_t params_len, avctp_rsp_cb func,
+					void *user_data)
+{
+	struct avrcp_header *pdu = (void *) session->tx_buf;
+	size_t len = sizeof(*pdu);
+
+	memset(pdu, 0, len);
+
+	hton24(pdu->company_id, IEEEID_BTSIG);
+	pdu->pdu_id = pdu_id;
+	pdu->packet_type = AVRCP_PACKET_TYPE_SINGLE;
+
+	if (params_len > 0) {
+		len += params_len;
+
+		if (len > session->tx_mtu)
+			return -ENOBUFS;
+
+		memcpy(pdu->params, params, params_len);
+		pdu->params_len = htons(params_len);
+	}
+
+	return avctp_send_vendordep_req(session->conn, code, subunit,
+					session->tx_buf, len, func, user_data);
+}
+
+int avrcp_get_capabilities(struct avrcp *session, avctp_rsp_cb func,
+							void *user_data)
+{
+	uint8_t param = CAP_EVENTS_SUPPORTED;
+
+	return avrcp_send_req(session, AVC_CTYPE_STATUS, AVC_SUBUNIT_PANEL,
+				AVRCP_GET_CAPABILITIES, &param, sizeof(param),
+				func, user_data);
+}
diff --git a/android/avrcp-lib.h b/android/avrcp-lib.h
index 23374295c..f7276327c 100644
--- a/android/avrcp-lib.h
+++ b/android/avrcp-lib.h
@@ -74,3 +74,6 @@ void avrcp_set_passthrough_handlers(struct avrcp *session,
 			void *user_data);
 int avrcp_init_uinput(struct avrcp *session, const char *name,
 							const char *address);
+
+int avrcp_get_capabilities(struct avrcp *session, avctp_rsp_cb func,
+							void *user_data);
diff --git a/android/avrcp.c b/android/avrcp.c
index acffd5642..8ff70b437 100644
--- a/android/avrcp.c
+++ b/android/avrcp.c
@@ -34,6 +34,7 @@
 #include "lib/sdp_lib.h"
 #include "src/log.h"
 #include "bluetooth.h"
+#include "avctp.h"
 #include "avrcp.h"
 #include "avrcp-lib.h"
 #include "hal-msg.h"
-- 
2.47.3