Commit 59c218ca authored by Luiz Augusto von Dentz's avatar Luiz Augusto von Dentz Committed by Marcel Holtmann
Browse files

Bluetooth: hci_vhci: Add force_suspend entry 



This adds force_suspend which can be used to force the controller into
suspend/resume state.

Signed-off-by: default avatarLuiz Augusto von Dentz <luiz.von.dentz@intel.com>
Signed-off-by: default avatarMarcel Holtmann <marcel@holtmann.org>
parent e1b77d68

drivers/bluetooth/hci_vhci.c

+53 −0
Original line number Diff line number Diff line
@@ -21,6 +21,7 @@ 


#include <linux/skbuff.h>

#include <linux/miscdevice.h>

#include <linux/debugfs.h>



#include <net/bluetooth/bluetooth.h>

#include <net/bluetooth/hci_core.h>
@@ -37,6 +38,8 @@ struct vhci_data { 


	struct mutex open_mutex;

	struct delayed_work open_timeout;



	bool suspended;

};



static int vhci_open_dev(struct hci_dev *hdev)
@@ -91,6 +94,53 @@ static int vhci_get_codec_config_data(struct hci_dev *hdev, __u8 type, 
	return 0;

}



static ssize_t force_suspend_read(struct file *file, char __user *user_buf,

				  size_t count, loff_t *ppos)

{

	struct vhci_data *data = file->private_data;

	char buf[3];



	buf[0] = data->suspended ? 'Y' : 'N';

	buf[1] = '\n';

	buf[2] = '\0';

	return simple_read_from_buffer(user_buf, count, ppos, buf, 2);

}



static ssize_t force_suspend_write(struct file *file,

				   const char __user *user_buf,

				   size_t count, loff_t *ppos)

{

	struct vhci_data *data = file->private_data;

	bool enable;

	int err;



	err = kstrtobool_from_user(user_buf, count, &enable);

	if (err)

		return err;



	if (data->suspended == enable)

		return -EALREADY;



	if (enable)

		err = hci_suspend_dev(data->hdev);

	else

		err = hci_resume_dev(data->hdev);



	if (err)

		return err;



	data->suspended = enable;



	return count;

}



static const struct file_operations force_suspend_fops = {

	.open		= simple_open,

	.read		= force_suspend_read,

	.write		= force_suspend_write,

	.llseek		= default_llseek,

};



static int __vhci_create_device(struct vhci_data *data, __u8 opcode)

{

	struct hci_dev *hdev;
@@ -149,6 +199,9 @@ static int __vhci_create_device(struct vhci_data *data, __u8 opcode) 
		return -EBUSY;

	}



	debugfs_create_file("force_suspend", 0644, hdev->debugfs, data,

			    &force_suspend_fops);



	hci_skb_pkt_type(skb) = HCI_VENDOR_PKT;



	skb_put_u8(skb, 0xff);