drivers/pnp/system.c

   1 /*
   2  * system.c - a driver for reserving pnp system resources
   3  *
   4  * Some code is based on pnpbios_core.c
   5  * Copyright 2002 Adam Belay <ambx1@neo.rr.com>
   6  * (c) Copyright 2007 Hewlett-Packard Development Company, L.P.
   7  *      Bjorn Helgaas <bjorn.helgaas@hp.com>
   8  */
   9
  10 #include <linux/pnp.h>
  11 #include <linux/device.h>
  12 #include <linux/init.h>
  13 #include <linux/slab.h>
  14 #include <linux/kernel.h>
  15 #include <linux/ioport.h>
  16
  17 static const struct pnp_device_id pnp_dev_table[] = {
  18         /* General ID for reserving resources */
  19         {"PNP0c02", 0},
  20         /* memory controller */
  21         {"PNP0c01", 0},
  22         {"", 0}
  23 };
  24
  25 static void reserve_range(const char *pnpid, resource_size_t start,
  26                           resource_size_t end, int port)
  27 {
  28         struct resource *res;
  29         char *regionid;
  30
  31         regionid = kmalloc(16, GFP_KERNEL);
  32         if (regionid == NULL)
  33                 return;
  34         snprintf(regionid, 16, "pnp %s", pnpid);
  35         if (port)
  36                 res = request_region(start, end - start + 1, regionid);
  37         else
  38                 res = request_mem_region(start, end - start + 1, regionid);
  39         if (res == NULL)
  40                 kfree(regionid);
  41         else
  42                 res->flags &= ~IORESOURCE_BUSY;
  43         /*
  44          * Failures at this point are usually harmless. pci quirks for
  45          * example do reserve stuff they know about too, so we may well
  46          * have double reservations.
  47          */
  48         printk(KERN_INFO
  49                "pnp: %s: %s range 0x%llx-0x%llx %s reserved\n",
  50                pnpid, port ? "ioport" : "iomem",
  51                (unsigned long long)start, (unsigned long long)end,
  52                NULL != res ? "has been" : "could not be");
  53 }
  54
  55 static void reserve_resources_of_dev(const struct pnp_dev *dev)
  56 {
  57         int i;
  58
  59         for (i = 0; i < PNP_MAX_PORT; i++) {
  60                 if (!pnp_port_valid(dev, i))
  61                         continue;
  62                 if (pnp_port_start(dev, i) == 0)
  63                         continue;       /* disabled */
  64                 if (pnp_port_start(dev, i) < 0x100)
  65                         /*
  66                          * Below 0x100 is only standard PC hardware
  67                          * (pics, kbd, timer, dma, ...)
  68                          * We should not get resource conflicts there,
  69                          * and the kernel reserves these anyway
  70                          * (see arch/i386/kernel/setup.c).
  71                          * So, do nothing
  72                          */
  73                         continue;
  74                 if (pnp_port_end(dev, i) < pnp_port_start(dev, i))
  75                         continue;       /* invalid */
  76
  77                 reserve_range(dev->dev.bus_id, pnp_port_start(dev, i),
  78                               pnp_port_end(dev, i), 1);
  79         }
  80
  81         for (i = 0; i < PNP_MAX_MEM; i++) {
  82                 if (!pnp_mem_valid(dev, i))
  83                         continue;
  84
  85                 reserve_range(dev->dev.bus_id, pnp_mem_start(dev, i),
  86                               pnp_mem_end(dev, i), 0);
  87         }
  88
  89         return;
  90 }
  91
  92 static int system_pnp_probe(struct pnp_dev *dev,
  93                             const struct pnp_device_id *dev_id)
  94 {
  95         reserve_resources_of_dev(dev);
  96         return 0;
  97 }
  98
  99 static struct pnp_driver system_pnp_driver = {
 100         .name = "system",
 101         .id_table = pnp_dev_table,
 102         .flags = PNP_DRIVER_RES_DO_NOT_CHANGE,
 103         .probe = system_pnp_probe,
 104         .remove = NULL,
 105 };
 106
 107 static int __init pnp_system_init(void)
 108 {
 109         return pnp_register_driver(&system_pnp_driver);
 110 }
 111
 112 /**
 113  * Reserve motherboard resources after PCI claim BARs,
 114  * but before PCI assign resources for uninitialized PCI devices
 115  */
 116 fs_initcall(pnp_system_init);