Commit f6d3c6e7 authored by Andrei Emeltchenko's avatar Andrei Emeltchenko Committed by Johan Hedberg
Browse files

Bluetooth: A2MP: Build and Send msg helpers 



Helper function to build and send A2MP messages.

Signed-off-by: default avatarAndrei Emeltchenko <andrei.emeltchenko@intel.com>
Signed-off-by: default avatarGustavo Padovan <gustavo.padovan@collabora.co.uk>
parent 9740e49d

include/net/bluetooth/a2mp.h

+7 −0
Original line number Diff line number Diff line
@@ -24,6 +24,13 @@ struct amp_mgr { 
	unsigned long		flags;

};



struct a2mp_cmd {

	__u8	code;

	__u8	ident;

	__le16	len;

	__u8	data[0];

} __packed;



void amp_mgr_get(struct amp_mgr *mgr);

int amp_mgr_put(struct amp_mgr *mgr);

net/bluetooth/a2mp.c

+46 −0
Original line number Diff line number Diff line
@@ -17,6 +17,52 @@ 
#include <net/bluetooth/l2cap.h>

#include <net/bluetooth/a2mp.h>



/* A2MP build & send command helper functions */

static struct a2mp_cmd *__a2mp_build(u8 code, u8 ident, u16 len, void *data)

{

	struct a2mp_cmd *cmd;

	int plen;



	plen = sizeof(*cmd) + len;

	cmd = kzalloc(plen, GFP_KERNEL);

	if (!cmd)

		return NULL;



	cmd->code = code;

	cmd->ident = ident;

	cmd->len = cpu_to_le16(len);



	memcpy(cmd->data, data, len);



	return cmd;

}



static void a2mp_send(struct amp_mgr *mgr, u8 code, u8 ident, u16 len,

		      void *data)

{

	struct l2cap_chan *chan = mgr->a2mp_chan;

	struct a2mp_cmd *cmd;

	u16 total_len = len + sizeof(*cmd);

	struct kvec iv;

	struct msghdr msg;



	cmd = __a2mp_build(code, ident, len, data);

	if (!cmd)

		return;



	iv.iov_base = cmd;

	iv.iov_len = total_len;



	memset(&msg, 0, sizeof(msg));



	msg.msg_iov = (struct iovec *) &iv;

	msg.msg_iovlen = 1;



	l2cap_chan_send(chan, &msg, total_len, 0);



	kfree(cmd);

}



static struct l2cap_ops a2mp_chan_ops = {

	.name = "L2CAP A2MP channel",

};