Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 4eb3cbc4 authored by Jeremy Cline's avatar Jeremy Cline Committed by Marcel Holtmann
Browse files

Bluetooth: hci_h5: Add vendor setup, open, and close callbacks 



Allow vendor-specific setup, open, and close functions to be defined.

Signed-off-by: default avatarJeremy Cline <jeremy@jcline.org>
[hdegoede@redhat.com: Port from bt3wire.c to hci_h5.c, drop dt support]
Signed-off-by: default avatarHans de Goede <hdegoede@redhat.com>
Signed-off-by: default avatarMarcel Holtmann <marcel@holtmann.org>
parent ce945552

drivers/bluetooth/hci_h5.c

+39 −1
Original line number Diff line number Diff line
@@ -21,8 +21,10 @@ 
 *

 */



#include <linux/kernel.h>

#include <linux/acpi.h>

#include <linux/errno.h>

#include <linux/kernel.h>

#include <linux/mod_devicetable.h>

#include <linux/serdev.h>

#include <linux/skbuff.h>
@@ -99,6 +101,15 @@ struct h5 { 
		H5_SLEEPING,

		H5_WAKING_UP,

	} sleep;



	const struct h5_vnd *vnd;

	const char *id;

};



struct h5_vnd {

	int (*setup)(struct h5 *h5);

	void (*open)(struct h5 *h5);

	void (*close)(struct h5 *h5);

};



static void h5_reset_rx(struct h5 *h5);
@@ -218,6 +229,9 @@ static int h5_open(struct hci_uart *hu) 


	h5->tx_win = H5_TX_WIN_MAX;



	if (h5->vnd && h5->vnd->open)

		h5->vnd->open(h5);



	set_bit(HCI_UART_INIT_PENDING, &hu->hdev_flags);



	/* Send initial sync request */
@@ -237,12 +251,25 @@ static int h5_close(struct hci_uart *hu) 
	skb_queue_purge(&h5->rel);

	skb_queue_purge(&h5->unrel);



	if (h5->vnd && h5->vnd->close)

		h5->vnd->close(h5);



	if (!hu->serdev)

		kfree(h5);



	return 0;

}



static int h5_setup(struct hci_uart *hu)

{

	struct h5 *h5 = hu->priv;



	if (h5->vnd && h5->vnd->setup)

		return h5->vnd->setup(h5);



	return 0;

}



static void h5_pkt_cull(struct h5 *h5)

{

	struct sk_buff *skb, *tmp;
@@ -753,6 +780,7 @@ static const struct hci_uart_proto h5p = { 
	.name		= "Three-wire (H5)",

	.open		= h5_open,

	.close		= h5_close,

	.setup		= h5_setup,

	.recv		= h5_recv,

	.enqueue	= h5_enqueue,

	.dequeue	= h5_dequeue,
@@ -761,6 +789,7 @@ static const struct hci_uart_proto h5p = { 


static int h5_serdev_probe(struct serdev_device *serdev)

{

	const struct acpi_device_id *match;

	struct device *dev = &serdev->dev;

	struct h5 *h5;
@@ -774,6 +803,15 @@ static int h5_serdev_probe(struct serdev_device *serdev) 
	h5->serdev_hu.serdev = serdev;

	serdev_device_set_drvdata(serdev, h5);



	if (has_acpi_companion(dev)) {

		match = acpi_match_device(dev->driver->acpi_match_table, dev);

		if (!match)

			return -ENODEV;



		h5->vnd = (const struct h5_vnd *)match->driver_data;

		h5->id  = (char *)match->id;

	}



	return hci_uart_register_device(&h5->serdev_hu, &h5p);

}