Re: [RFC] mgmt: Add support for Passkey handling

[Andrei Emeltchenko <andrei.emeltchenko.news@gmail.com>]

Hi Hemant,

On Mon, Dec 05, 2011 at 05:16:26PM +0530, Hemant Gupta wrote:
> This patch adds support for handling Passkey Requests
> and response over management interface.
> ---
>  lib/mgmt.h        |   17 ++++++++++
>  plugins/mgmtops.c |   86 ++++++++++++++++++++++++++++++++++++++++++++++------
>  2 files changed, 93 insertions(+), 10 deletions(-)
> 
> diff --git a/lib/mgmt.h b/lib/mgmt.h
> index 3960815..a85957d 100644
> --- a/lib/mgmt.h
> +++ b/lib/mgmt.h
> @@ -242,6 +242,17 @@ struct mgmt_cp_set_fast_connectable {
>  	uint8_t enable;
>  } __packed;
>  
> +#define MGMT_OP_USER_PASSKEY_REPLY	0x0020
> +struct mgmt_cp_user_passkey_reply {
> +	bdaddr_t bdaddr;
> +	__le32 passkey;
> +} __packed;
> +
> +#define MGMT_OP_USER_PASSKEY_NEG_REPLY	0x0021
> +struct mgmt_cp_user_passkey_neg_reply {
> +	bdaddr_t bdaddr;
> +} __packed;
> +
>  #define MGMT_EV_CMD_COMPLETE		0x0001
>  struct mgmt_ev_cmd_complete {
>  	uint16_t opcode;
> @@ -336,3 +347,9 @@ struct mgmt_ev_device_blocked {
>  struct mgmt_ev_device_unblocked {
>  	bdaddr_t bdaddr;
>  } __packed;
> +
> +#define MGMT_EV_USER_PASSKEY_REQUEST	0x0017
> +struct mgmt_ev_user_passkey_request {
> +	bdaddr_t bdaddr;
> +} __packed;
> +
> diff --git a/plugins/mgmtops.c b/plugins/mgmtops.c
> index b9e9ad6..ef88ae6 100644
> --- a/plugins/mgmtops.c
> +++ b/plugins/mgmtops.c
> @@ -615,6 +615,79 @@ static int mgmt_confirm_reply(int index, bdaddr_t *bdaddr, gboolean success)
>  	return 0;
>  }
>  
> +static int mgmt_passkey_reply(int index, bdaddr_t *bdaddr, uint32_t passkey)
> +{
> +	char buf[MGMT_HDR_SIZE + sizeof(struct mgmt_cp_user_passkey_reply)];
> +	struct mgmt_hdr *hdr = (void *) buf;
> +	size_t buf_len;
> +	char addr[18];
> +
> +	ba2str(bdaddr, addr);
> +	DBG("index %d addr %s passkey %06u", index, addr, passkey);

isn't it too much overhead to fill in (and to have) buffer even when debug disabled?

> +
> +	memset(buf, 0, sizeof(buf));
> +
> +	if (passkey == INVALID_PASSKEY) {
> +		struct mgmt_cp_user_passkey_neg_reply *cp;
> +
> +		hdr->opcode = htobs(MGMT_OP_USER_PASSKEY_NEG_REPLY);
> +		hdr->len = htobs(sizeof(*cp));
> +		hdr->index = htobs(index);
> +
> +		cp = (void *) &buf[sizeof(*hdr)];

The code above is a cool hackers code :-)

Best regards 
Andrei Emeltchenko 

> +		bacpy(&cp->bdaddr, bdaddr);
> +
> +		buf_len = sizeof(*hdr) + sizeof(*cp);
> +	} else {
> +		struct mgmt_cp_user_passkey_reply *cp;
> +
> +		hdr->opcode = htobs(MGMT_OP_USER_PASSKEY_REPLY);
> +		hdr->len = htobs(sizeof(*cp));
> +		hdr->index = htobs(index);
> +
> +		cp = (void *) &buf[sizeof(*hdr)];
> +		bacpy(&cp->bdaddr, bdaddr);
> +		cp->passkey = htobl(passkey);
> +
> +		buf_len = sizeof(*hdr) + sizeof(*cp);
> +	}
> +
> +	if (write(mgmt_sock, buf, buf_len) < 0)
> +		return -errno;
> +
> +	return 0;
> +}
> +
> +static void mgmt_passkey_request(int sk, uint16_t index, void *buf, size_t len)
> +{
> +	struct mgmt_ev_user_passkey_request *ev = buf;
> +	struct controller_info *info;
> +	char addr[18];
> +	int err;
> +
> +	if (len < sizeof(*ev)) {
> +		error("Too small pin_code_request event");
> +		return;
> +	}
> +
> +	ba2str(&ev->bdaddr, addr);
> +
> +	DBG("hci%u %s", index, addr);
> +
> +	if (index > max_index) {
> +		error("Unexpected index %u in passkey_request event", index);
> +		return;
> +	}
> +
> +	info = &controllers[index];
> +
> +	err = btd_event_user_passkey(&info->bdaddr, &ev->bdaddr);
> +	if (err < 0) {
> +		error("btd_event_request_pin: %s", strerror(-err));
> +		mgmt_passkey_reply(index, &ev->bdaddr, INVALID_PASSKEY);
> +	}
> +}
> +
>  struct confirm_data {
>  	int index;
>  	bdaddr_t bdaddr;
> @@ -1576,6 +1649,9 @@ static gboolean mgmt_event(GIOChannel *io, GIOCondition cond, gpointer user_data
>  	case MGMT_EV_DEVICE_UNBLOCKED:
>  		mgmt_device_unblocked(sk, index, buf + MGMT_HDR_SIZE, len);
>  		break;
> +	case MGMT_EV_USER_PASSKEY_REQUEST:
> +		mgmt_passkey_request(sk, index, buf + MGMT_HDR_SIZE, len);
> +		break;
>  	default:
>  		error("Unknown Management opcode %u (index %u)", opcode, index);
>  		break;
> @@ -1919,16 +1995,6 @@ static int mgmt_remove_bonding(int index, bdaddr_t *bdaddr)
>  	return 0;
>  }
>  
> -static int mgmt_passkey_reply(int index, bdaddr_t *bdaddr, uint32_t passkey)
> -{
> -	char addr[18];
> -
> -	ba2str(bdaddr, addr);
> -	DBG("index %d addr %s passkey %06u", index, addr, passkey);
> -
> -	return -ENOSYS;
> -}
> -
>  static int mgmt_encrypt_link(int index, bdaddr_t *dst, bt_hci_result_t cb,
>  							gpointer user_data)
>  {
> -- 
> 1.6.6.1
> 
> --
> To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
> the body of a message to majordomo@vger.kernel.org
> More majordomo info at  http://vger.kernel.org/majordomo-info.html