Bluetooth: hci_vhci: Add force_prevent_wake entry

This adds force_prevent_wake which can be used to force a certain state
while interacting with force_suspend.

Signed-off-by: Luiz Augusto von Dentz <luiz.von.dentz@intel.com>
Signed-off-by: Marcel Holtmann <marcel@holtmann.org>

diff --git a/drivers/bluetooth/hci_vhci.c b/drivers/bluetooth/hci_vhci.c
index 6cc326c55a24d6dc6c352db207295c05f45383fd..acf2544dbb0547f6699c17230b30bddd8e436072 100644 (file)
--- a/drivers/bluetooth/hci_vhci.c
+++ b/drivers/bluetooth/hci_vhci.c
@@ -40,6 +40,7 @@ struct vhci_data {
        struct delayed_work open_timeout;
 
        bool suspended;
+       bool prevent_wake;
 };
 
 static int vhci_open_dev(struct hci_dev *hdev)
@@ -94,6 +95,13 @@ static int vhci_get_codec_config_data(struct hci_dev *hdev, __u8 type,
        return 0;
 }
 
+static bool vhci_prevent_wake(struct hci_dev *hdev)
+{
+       struct vhci_data *data = hci_get_drvdata(hdev);
+
+       return data->prevent_wake;
+}
+
 static ssize_t force_suspend_read(struct file *file, char __user *user_buf,
                                  size_t count, loff_t *ppos)
 {
@@ -141,6 +149,43 @@ static const struct file_operations force_suspend_fops = {
        .llseek         = default_llseek,
 };
 
+static ssize_t force_prevent_wake_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->prevent_wake ? 'Y' : 'N';
+       buf[1] = '\n';
+       buf[2] = '\0';
+       return simple_read_from_buffer(user_buf, count, ppos, buf, 2);
+}
+
+static ssize_t force_prevent_wake_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->prevent_wake == enable)
+               return -EALREADY;
+
+       return count;
+}
+
+static const struct file_operations force_prevent_wake_fops = {
+       .open           = simple_open,
+       .read           = force_prevent_wake_read,
+       .write          = force_prevent_wake_write,
+       .llseek         = default_llseek,
+};
+
 static int __vhci_create_device(struct vhci_data *data, __u8 opcode)
 {
        struct hci_dev *hdev;
@@ -182,6 +227,7 @@ static int __vhci_create_device(struct vhci_data *data, __u8 opcode)
        hdev->send  = vhci_send_frame;
        hdev->get_data_path_id = vhci_get_data_path_id;
        hdev->get_codec_config_data = vhci_get_codec_config_data;
+       hdev->prevent_wake = vhci_prevent_wake;
 
        /* bit 6 is for external configuration */
        if (opcode & 0x40)
@@ -202,6 +248,9 @@ static int __vhci_create_device(struct vhci_data *data, __u8 opcode)
        debugfs_create_file("force_suspend", 0644, hdev->debugfs, data,
                            &force_suspend_fops);
 
+       debugfs_create_file("force_prevent_wake", 0644, hdev->debugfs, data,
+                           &force_prevent_wake_fops);
+
        hci_skb_pkt_type(skb) = HCI_VENDOR_PKT;
 
        skb_put_u8(skb, 0xff);