Start handling audio devices via vga_switcheroo

This is an attempt to notify the audio driver (snd-hda-intel) that the
graphics card is being disabled to prevent access to a sleeping device.

TODO:
 - System suspend/resume is not really working properly with this.

Addresses https://github.com/Bumblebee-Project/bbswitch/issues/18

bbswitch.c

@@ -35,6 +35,13 @@
 #include <linux/suspend.h>
 #include <linux/seq_file.h>
 #include <linux/pm_runtime.h>
+#include <linux/pm_domain.h>
+#include <linux/vga_switcheroo.h>
+#include <linux/version.h>
+
+#if LINUX_VERSION_CODE < KERNEL_VERSION(3,8,0)
+#   define ACPI_HANDLE DEVICE_ACPI_HANDLE
+#endif
 
 #define BBSWITCH_VERSION "0.8"
 
@@ -86,11 +93,15 @@ http://lxr.linux.no/#linux+v3.1.5/drivers/gpu/drm/i915/intel_acpi.c
 #define DSM_TYPE_NVIDIA         2
 static int dsm_type = DSM_TYPE_UNSUPPORTED;
 
+/* The cached name of the discrete device (of the form "0000:01:00.0"). */
+static char dis_dev_name[16];
+/* dis_dev is non-NULL iff it is currently bound by bbswitch (and off). */
 static struct pci_dev *dis_dev;
 static acpi_handle dis_handle;
 
-/* whether the card was off before suspend or not; on: 0, off: 1 */
+/* The PM domain that wraps the PCI device, used to ensure that power is
-static int dis_before_suspend_disabled;
+ * available before the device is put in D0. ("Nvidia" DSM and PR3). */
+static struct dev_pm_domain pm_domain;
 
 static char *buffer_to_string(const char *buffer, size_t n, char *target) {
     int i;
@@ -229,82 +240,219 @@ static int bbswitch_acpi_on(void) {
 
 // Returns 1 if the card is disabled, 0 if enabled
 static int is_card_disabled(void) {
-    u32 cfg_word;
+    /* Assume that the device is disabled when our PCI driver found a device. */
-    // read first config word which contains Vendor and Device ID. If all bits
+    return dis_dev != NULL;
-    // are enabled, the device is assumed to be off
-    pci_read_config_dword(dis_dev, 0, &cfg_word);
-    // if one of the bits is not enabled (the card is enabled), the inverted
-    // result will be non-zero and hence logical not will make it 0 ("false")
-    return !~cfg_word;
 }
 
-static void bbswitch_off(void) {
-    if (is_card_disabled())
-        return;
 
-    // to prevent the system from possibly locking up, don't disable the device
+/* Power source handling. */
-    // if it's still in use by a driver (i.e. nouveau or nvidia)
+
-    if (dis_dev->driver) {
+static int bbswitch_pmd_runtime_suspend(struct device *dev)
-        pr_warn("device %s is in use by driver '%s', refusing OFF\n",
+{
-            dev_name(&dis_dev->dev), dis_dev->driver->name);
+    int ret;
-        return;
+
+    pr_debug("Preparing for runtime suspend.\n");
+
+    /* Put the device in D3. */
+    ret = dev->bus->pm->runtime_suspend(dev);
+    if (ret)
+        return ret;
+
+    bbswitch_acpi_off();
+    /* TODO For PR3, disable them. */
+    return 0;
 }
 
+static int bbswitch_pmd_runtime_resume(struct device *dev)
+{
+    pr_info("enabling discrete graphics\n");
+
+    bbswitch_acpi_on();
+    /* TODO For PR3, enable them. */
+
+    /* Now ensure that the device is actually put in D0 by PCI. */
+    return dev->bus->pm->runtime_resume(dev);
+}
+
+static void bbswitch_pmd_set(struct device *dev)
+{
+    pm_domain.ops = *dev->bus->pm;
+    pm_domain.ops.runtime_resume = bbswitch_pmd_runtime_resume;
+    pm_domain.ops.runtime_suspend = bbswitch_pmd_runtime_suspend;
+    dev_pm_domain_set(dev, &pm_domain);
+}
+
+
+/* Nvidia device itself. */
+
+static int bbswitch_pci_runtime_suspend(struct device *dev)
+{
+    struct pci_dev *pdev = to_pci_dev(dev);
+
     pr_info("disabling discrete graphics\n");
 
-    if (bbswitch_optimus_dsm()) {
+    /* Ensure that the audio driver knows not to touch us. */
-        pr_warn("Optimus ACPI call failed, the device is not disabled\n");
+    vga_switcheroo_set_dynamic_switch(pdev, VGA_SWITCHEROO_OFF);
-        return;
+
+    bbswitch_optimus_dsm();
+
+    /* Save state now that the device is still awake, makes PCI layer happy */
+    pci_save_state(pdev);
+    /* TODO if _PR3 is supported, should this be PCI_D3hot? */
+    pci_set_power_state(pdev, PCI_D3hot);
+    return 0;
 }
 
-    pci_save_state(dis_dev);
+static int bbswitch_pci_runtime_resume(struct device *dev)
-    pci_clear_master(dis_dev);
+{
-    pci_disable_device(dis_dev);
+    struct pci_dev *pdev = to_pci_dev(dev);
-    do {
+
-        struct acpi_device *ad = NULL;
+    pr_debug("Finishing runtime resume.\n");
-        int r;
 
-        r = acpi_bus_get_device(dis_handle, &ad);
+    /* Resume audio driver. */
-        if (r || !ad) {
+    vga_switcheroo_set_dynamic_switch(pdev, VGA_SWITCHEROO_ON);
-            pr_warn("Cannot get ACPI device for PCI device\n");
+    return 0;
-            break;
 }
-        if (ad->power.state == ACPI_STATE_UNKNOWN) {
+
-            pr_debug("ACPI power state is unknown, forcing D0\n");
+static const struct dev_pm_ops bbswitch_pci_pm_ops = {
-            ad->power.state = ACPI_STATE_D0;
+    .runtime_suspend = bbswitch_pci_runtime_suspend,
+    .runtime_resume = bbswitch_pci_runtime_resume,
+    /* No runtime_idle callback, the default zero delay is sufficient. */
+};
+
+static int bbswitch_switcheroo_switchto(enum vga_switcheroo_client_id id)
+{
+    /* We do not support switching, only power on/off. */
+    return -ENOSYS;
 }
-    } while (0);
-    pci_set_power_state(dis_dev, PCI_D3cold);
 
-    if (bbswitch_acpi_off())
+static enum vga_switcheroo_client_id bbswitch_switcheroo_get_client_id(struct pci_dev *pdev)
-        pr_warn("The discrete card could not be disabled by a _DSM call\n");
+{
+    /* Our registered client is always the discrete GPU. */
+    return VGA_SWITCHEROO_DIS;
 }
 
-static void bbswitch_on(void) {
+static const struct vga_switcheroo_handler bbswitch_handler = {
-    if (!is_card_disabled())
+    .switchto = bbswitch_switcheroo_switchto,
-        return;
+    .get_client_id = bbswitch_switcheroo_get_client_id,
+};
 
-    pr_info("enabling discrete graphics\n");
 
-    if (bbswitch_acpi_on())
+static void bbswitch_switcheroo_set_gpu_state(struct pci_dev *pdev, enum vga_switcheroo_state state)
-        pr_warn("The discrete card could not be enabled by a _DSM call\n");
+{
+    /* Nothing to do, we handle the PM domain ourselves. Perhaps we can add
+     * backwards compatibility with older kernels in this way and workaround
+     * bugs? */
+    pr_debug("set_gpu_state to %s\n", state == VGA_SWITCHEROO_ON ? "ON" : "OFF");
+}
 
-    pci_set_power_state(dis_dev, PCI_D0);
+static bool bbswitch_switcheroo_can_switch(struct pci_dev *pdev)
-    pci_restore_state(dis_dev);
+{
-    if (pci_enable_device(dis_dev))
+    /* We do not support switching between IGD/DIS. */
-        pr_warn("failed to enable %s\n", dev_name(&dis_dev->dev));
+    return false;
-    pci_set_master(dis_dev);
 }
 
-/* power bus so we can read PCI configuration space */
+static const struct vga_switcheroo_client_ops bbswitch_switcheroo_ops = {
-static void dis_dev_get(void) {
+    .set_gpu_state = bbswitch_switcheroo_set_gpu_state,
-    if (dis_dev->bus && dis_dev->bus->self)
+    .can_switch = bbswitch_switcheroo_can_switch,
-        pm_runtime_get_sync(&dis_dev->bus->self->dev);
+};
+
+static int bbswitch_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id)
+{
+    /* Only bind to the device which we discovered before. */
+    if (strcmp(dev_name(&pdev->dev), dis_dev_name))
+        return -ENODEV;
+
+    pr_debug("Found PCI device\n");
+    dis_dev = pdev;
+
+    bbswitch_pmd_set(&pdev->dev);
+#if LINUX_VERSION_CODE >= KERNEL_VERSION(4,5,0)
+    vga_switcheroo_register_handler(&bbswitch_handler, 0);
+#else
+    vga_switcheroo_register_handler(&bbswitch_handler);
+#endif
+    vga_switcheroo_register_client(pdev, &bbswitch_switcheroo_ops, true);
+
+    /* Prevent kernel from detaching the PCI device for some devices that
+     * generate hotplug events. The graphics card is typically not physically
+     * removable. */
+    pci_ignore_hotplug(pdev);
+
+    pm_runtime_set_active(&pdev->dev); /* clear any errors */
+    /* Use autosuspend to avoid lspci waking up the device multiple times. */
+    pm_runtime_set_autosuspend_delay(&pdev->dev, 2000);
+    pm_runtime_use_autosuspend(&pdev->dev);
+    pm_runtime_allow(&pdev->dev);
+    pm_runtime_put_autosuspend(&pdev->dev);
+    return 0;
 }
 
-static void dis_dev_put(void) {
+static void bbswitch_pci_remove(struct pci_dev *pdev)
-    if (dis_dev->bus && dis_dev->bus->self)
+{
-        pm_runtime_put_sync(&dis_dev->bus->self->dev);
+    pr_debug("Removing PCI device\n");
+
+    pm_runtime_get_noresume(&pdev->dev);
+    pm_runtime_dont_use_autosuspend(&pdev->dev);
+    pm_runtime_forbid(&pdev->dev);
+
+    vga_switcheroo_unregister_client(pdev);
+    vga_switcheroo_unregister_handler();
+    dev_pm_domain_set(&pdev->dev, NULL);
+
+    dis_dev = NULL;
+}
+
+static const struct pci_device_id pciidlist[] = {
+    { PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_ANY_ID),
+      PCI_CLASS_DISPLAY_VGA << 8, 0xffff00 },
+    { PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_ANY_ID),
+      PCI_CLASS_DISPLAY_3D << 8, 0xffff00 },
+    { 0, 0, 0 },
+};
+
+static struct pci_driver bbswitch_pci_driver = {
+    .name = KBUILD_MODNAME,
+    .id_table = pciidlist,
+    .probe  = bbswitch_pci_probe,
+    .remove = bbswitch_pci_remove,
+    .driver.pm = &bbswitch_pci_pm_ops,
+};
+
+
+static void bbswitch_off(void) {
+    int ret;
+
+    /* Do nothing if the device was disabled before. */
+    if (dis_dev)
+        return;
+
+    ret = pci_register_driver(&bbswitch_pci_driver);
+    if (ret) {
+        pr_warn("Cannot register PCI device\n");
+        return;
+    }
+
+    /* If the probe failed, remove the driver such that it can be reprobed on
+     * the next registration. */
+    if (!dis_dev) {
+#if 0
+        /* TODO discover the other driver name if possible. */
+        pr_warn("device %s is in use by driver '%s', refusing OFF\n",
+            dev_name(&dis_dev->dev), dis_dev->driver->name);
+#endif
+
+        pr_warn("Could not bind to device, is it in use by an other driver?\n");
+        pci_unregister_driver(&bbswitch_pci_driver);
+    }
+}
+
+static void bbswitch_on(void) {
+    /* Do nothing if no device exists that was previously disabled. */
+    if (!dis_dev)
+        return;
+
+    pci_unregister_driver(&bbswitch_pci_driver);
 }
 
 static ssize_t bbswitch_proc_write(struct file *fp, const char __user *buff,
@@ -317,64 +465,25 @@ static ssize_t bbswitch_proc_write(struct file *fp, const char __user *buff,
     if (copy_from_user(cmd, buff, len))
         return -EFAULT;
 
-    dis_dev_get();
-
     if (strncmp(cmd, "OFF", 3) == 0)
         bbswitch_off();
 
     if (strncmp(cmd, "ON", 2) == 0)
         bbswitch_on();
 
-    dis_dev_put();
-
     return len;
 }
 
 static int bbswitch_proc_show(struct seq_file *seqfp, void *p) {
     // show the card state. Example output: 0000:01:00:00 ON
-    dis_dev_get();
+    seq_printf(seqfp, "%s %s\n", dis_dev_name,
-    seq_printf(seqfp, "%s %s\n", dev_name(&dis_dev->dev),
              is_card_disabled() ? "OFF" : "ON");
-    dis_dev_put();
     return 0;
 }
 static int bbswitch_proc_open(struct inode *inode, struct file *file) {
     return single_open(file, bbswitch_proc_show, NULL);
 }
 
-static int bbswitch_pm_handler(struct notifier_block *nbp,
-    unsigned long event_type, void *p) {
-    switch (event_type) {
-    case PM_HIBERNATION_PREPARE:
-    case PM_SUSPEND_PREPARE:
-        dis_dev_get();
-        dis_before_suspend_disabled = is_card_disabled();
-        // enable the device before suspend to avoid the PCI config space from
-        // being saved incorrectly
-        if (dis_before_suspend_disabled)
-            bbswitch_on();
-        dis_dev_put();
-        break;
-    case PM_POST_HIBERNATION:
-    case PM_POST_SUSPEND:
-    case PM_POST_RESTORE:
-        // after suspend, the card is on, but if it was off before suspend,
-        // disable it again
-        if (dis_before_suspend_disabled) {
-            dis_dev_get();
-            bbswitch_off();
-            dis_dev_put();
-        }
-        break;
-    case PM_RESTORE_PREPARE:
-        // deliberately don't do anything as it does not occur before suspend
-        // nor hibernate, but before restoring a saved image. In that case,
-        // either PM_POST_HIBERNATION or PM_POST_RESTORE will be called
-        break;
-    }
-    return 0;
-}
-
 static struct file_operations bbswitch_fops = {
     .open   = bbswitch_proc_open,
     .read   = seq_read,
@@ -383,10 +492,6 @@ static struct file_operations bbswitch_fops = {
     .release= single_release
 };
 
-static struct notifier_block nb = {
-    .notifier_call = &bbswitch_pm_handler
-};
-
 static int __init bbswitch_init(void) {
     struct proc_dir_entry *acpi_entry;
     struct pci_dev *pdev = NULL;
@@ -403,13 +508,7 @@ static int __init bbswitch_init(void) {
             pci_class != PCI_CLASS_DISPLAY_3D)
             continue;
 
-#ifdef ACPI_HANDLE
-        /* since Linux 3.8 */
         handle = ACPI_HANDLE(&pdev->dev);
-#else
-        /* removed since Linux 3.13 */
-        handle = DEVICE_ACPI_HANDLE(&pdev->dev);
-#endif
         if (!handle) {
             pr_warn("cannot find ACPI handle for VGA device %s\n",
                 dev_name(&pdev->dev));
@@ -423,7 +522,7 @@ static int __init bbswitch_init(void) {
             pr_info("Found integrated VGA device %s: %s\n",
                 dev_name(&pdev->dev), (char *)buf.pointer);
         } else {
-            dis_dev = pdev;
+            strlcpy(dis_dev_name, dev_name(&pdev->dev), sizeof(dis_dev_name));
             dis_handle = handle;
             pr_info("Found discrete VGA device %s: %s\n",
                 dev_name(&pdev->dev), (char *)buf.pointer);
@@ -431,7 +530,7 @@ static int __init bbswitch_init(void) {
         kfree(buf.pointer);
     }
 
-    if (dis_dev == NULL) {
+    if (dis_handle == NULL) {
         pr_err("No discrete VGA device found\n");
         return -ENODEV;
     }
@@ -463,25 +562,11 @@ static int __init bbswitch_init(void) {
         return -ENOMEM;
     }
 
-    dis_dev_get();
+    if (load_state == CARD_OFF)
-
-    if (!is_card_disabled()) {
-        /* We think the card is enabled, so ensure the kernel does as well */
-        if (pci_enable_device(dis_dev))
-            pr_warn("failed to enable %s\n", dev_name(&dis_dev->dev));
-    }
-
-    if (load_state == CARD_ON)
-        bbswitch_on();
-    else if (load_state == CARD_OFF)
         bbswitch_off();
 
     pr_info("Succesfully loaded. Discrete card %s is %s\n",
-        dev_name(&dis_dev->dev), is_card_disabled() ? "off" : "on");
+        dis_dev_name, is_card_disabled() ? "off" : "on");
-
-    dis_dev_put();
-
-    register_pm_notifier(&nb);
 
     return 0;
 }
@@ -489,20 +574,8 @@ static int __init bbswitch_init(void) {
 static void __exit bbswitch_exit(void) {
     remove_proc_entry("bbswitch", acpi_root_dir);
 
-    dis_dev_get();
-
-    if (unload_state == CARD_ON)
     bbswitch_on();
-    else if (unload_state == CARD_OFF)
+    pr_info("Unloaded\n");
-        bbswitch_off();
-
-    pr_info("Unloaded. Discrete card %s is %s\n",
-        dev_name(&dis_dev->dev), is_card_disabled() ? "off" : "on");
-
-    dis_dev_put();
-
-    if (nb.notifier_call)
-        unregister_pm_notifier(&nb);
 }
 
 module_init(bbswitch_init);