|
@@ -7,6 +7,7 @@
|
|
* Configuration Registers.
|
|
* Configuration Registers.
|
|
*
|
|
*
|
|
* Copyright (c) 2010 CompuLab Ltd
|
|
* Copyright (c) 2010 CompuLab Ltd
|
|
|
|
+ * Copyright (c) 2014 Intel Corp.
|
|
* Author: Denis Turischev <denis@compulab.co.il>
|
|
* Author: Denis Turischev <denis@compulab.co.il>
|
|
*
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* This program is free software; you can redistribute it and/or modify
|
|
@@ -17,10 +18,6 @@
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
* GNU General Public License for more details.
|
|
- *
|
|
|
|
- * You should have received a copy of the GNU General Public License
|
|
|
|
- * along with this program; see the file COPYING. If not, write to
|
|
|
|
- * the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
|
|
*/
|
|
*/
|
|
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/kernel.h>
|
|
@@ -37,123 +34,165 @@
|
|
#define GPIO_IO_SIZE 64
|
|
#define GPIO_IO_SIZE 64
|
|
#define GPIO_IO_SIZE_CENTERTON 128
|
|
#define GPIO_IO_SIZE_CENTERTON 128
|
|
|
|
|
|
|
|
+/* Intel Quark X1000 GPIO IRQ Number */
|
|
|
|
+#define GPIO_IRQ_QUARK_X1000 9
|
|
|
|
+
|
|
#define WDTBASE 0x84
|
|
#define WDTBASE 0x84
|
|
#define WDT_IO_SIZE 64
|
|
#define WDT_IO_SIZE 64
|
|
|
|
|
|
-static struct resource smbus_sch_resource = {
|
|
|
|
- .flags = IORESOURCE_IO,
|
|
|
|
-};
|
|
|
|
-
|
|
|
|
-static struct resource gpio_sch_resource = {
|
|
|
|
- .flags = IORESOURCE_IO,
|
|
|
|
-};
|
|
|
|
-
|
|
|
|
-static struct resource wdt_sch_resource = {
|
|
|
|
- .flags = IORESOURCE_IO,
|
|
|
|
|
|
+enum sch_chipsets {
|
|
|
|
+ LPC_SCH = 0, /* Intel Poulsbo SCH */
|
|
|
|
+ LPC_ITC, /* Intel Tunnel Creek */
|
|
|
|
+ LPC_CENTERTON, /* Intel Centerton */
|
|
|
|
+ LPC_QUARK_X1000, /* Intel Quark X1000 */
|
|
};
|
|
};
|
|
|
|
|
|
-static struct mfd_cell lpc_sch_cells[3];
|
|
|
|
-
|
|
|
|
-static struct mfd_cell isch_smbus_cell = {
|
|
|
|
- .name = "isch_smbus",
|
|
|
|
- .num_resources = 1,
|
|
|
|
- .resources = &smbus_sch_resource,
|
|
|
|
- .ignore_resource_conflicts = true,
|
|
|
|
|
|
+struct lpc_sch_info {
|
|
|
|
+ unsigned int io_size_smbus;
|
|
|
|
+ unsigned int io_size_gpio;
|
|
|
|
+ unsigned int io_size_wdt;
|
|
|
|
+ int irq_gpio;
|
|
};
|
|
};
|
|
|
|
|
|
-static struct mfd_cell sch_gpio_cell = {
|
|
|
|
- .name = "sch_gpio",
|
|
|
|
- .num_resources = 1,
|
|
|
|
- .resources = &gpio_sch_resource,
|
|
|
|
- .ignore_resource_conflicts = true,
|
|
|
|
-};
|
|
|
|
-
|
|
|
|
-static struct mfd_cell wdt_sch_cell = {
|
|
|
|
- .name = "ie6xx_wdt",
|
|
|
|
- .num_resources = 1,
|
|
|
|
- .resources = &wdt_sch_resource,
|
|
|
|
- .ignore_resource_conflicts = true,
|
|
|
|
|
|
+static struct lpc_sch_info sch_chipset_info[] = {
|
|
|
|
+ [LPC_SCH] = {
|
|
|
|
+ .io_size_smbus = SMBUS_IO_SIZE,
|
|
|
|
+ .io_size_gpio = GPIO_IO_SIZE,
|
|
|
|
+ .irq_gpio = -1,
|
|
|
|
+ },
|
|
|
|
+ [LPC_ITC] = {
|
|
|
|
+ .io_size_smbus = SMBUS_IO_SIZE,
|
|
|
|
+ .io_size_gpio = GPIO_IO_SIZE,
|
|
|
|
+ .io_size_wdt = WDT_IO_SIZE,
|
|
|
|
+ .irq_gpio = -1,
|
|
|
|
+ },
|
|
|
|
+ [LPC_CENTERTON] = {
|
|
|
|
+ .io_size_smbus = SMBUS_IO_SIZE,
|
|
|
|
+ .io_size_gpio = GPIO_IO_SIZE_CENTERTON,
|
|
|
|
+ .io_size_wdt = WDT_IO_SIZE,
|
|
|
|
+ .irq_gpio = -1,
|
|
|
|
+ },
|
|
|
|
+ [LPC_QUARK_X1000] = {
|
|
|
|
+ .io_size_gpio = GPIO_IO_SIZE,
|
|
|
|
+ .irq_gpio = GPIO_IRQ_QUARK_X1000,
|
|
|
|
+ },
|
|
};
|
|
};
|
|
|
|
|
|
static const struct pci_device_id lpc_sch_ids[] = {
|
|
static const struct pci_device_id lpc_sch_ids[] = {
|
|
- { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_SCH_LPC) },
|
|
|
|
- { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ITC_LPC) },
|
|
|
|
- { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_CENTERTON_ILB) },
|
|
|
|
|
|
+ { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_SCH_LPC), LPC_SCH },
|
|
|
|
+ { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_ITC_LPC), LPC_ITC },
|
|
|
|
+ { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_CENTERTON_ILB), LPC_CENTERTON },
|
|
|
|
+ { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_QUARK_X1000_ILB), LPC_QUARK_X1000 },
|
|
{ 0, }
|
|
{ 0, }
|
|
};
|
|
};
|
|
MODULE_DEVICE_TABLE(pci, lpc_sch_ids);
|
|
MODULE_DEVICE_TABLE(pci, lpc_sch_ids);
|
|
|
|
|
|
-static int lpc_sch_probe(struct pci_dev *dev,
|
|
|
|
- const struct pci_device_id *id)
|
|
|
|
|
|
+#define LPC_NO_RESOURCE 1
|
|
|
|
+#define LPC_SKIP_RESOURCE 2
|
|
|
|
+
|
|
|
|
+static int lpc_sch_get_io(struct pci_dev *pdev, int where, const char *name,
|
|
|
|
+ struct resource *res, int size)
|
|
{
|
|
{
|
|
unsigned int base_addr_cfg;
|
|
unsigned int base_addr_cfg;
|
|
unsigned short base_addr;
|
|
unsigned short base_addr;
|
|
- int i, cells = 0;
|
|
|
|
- int ret;
|
|
|
|
|
|
|
|
- pci_read_config_dword(dev, SMBASE, &base_addr_cfg);
|
|
|
|
|
|
+ if (size == 0)
|
|
|
|
+ return LPC_NO_RESOURCE;
|
|
|
|
+
|
|
|
|
+ pci_read_config_dword(pdev, where, &base_addr_cfg);
|
|
base_addr = 0;
|
|
base_addr = 0;
|
|
if (!(base_addr_cfg & (1 << 31)))
|
|
if (!(base_addr_cfg & (1 << 31)))
|
|
- dev_warn(&dev->dev, "Decode of the SMBus I/O range disabled\n");
|
|
|
|
|
|
+ dev_warn(&pdev->dev, "Decode of the %s I/O range disabled\n",
|
|
|
|
+ name);
|
|
else
|
|
else
|
|
base_addr = (unsigned short)base_addr_cfg;
|
|
base_addr = (unsigned short)base_addr_cfg;
|
|
|
|
|
|
if (base_addr == 0) {
|
|
if (base_addr == 0) {
|
|
- dev_warn(&dev->dev, "I/O space for SMBus uninitialized\n");
|
|
|
|
- } else {
|
|
|
|
- lpc_sch_cells[cells++] = isch_smbus_cell;
|
|
|
|
- smbus_sch_resource.start = base_addr;
|
|
|
|
- smbus_sch_resource.end = base_addr + SMBUS_IO_SIZE - 1;
|
|
|
|
|
|
+ dev_warn(&pdev->dev, "I/O space for %s uninitialized\n", name);
|
|
|
|
+ return LPC_SKIP_RESOURCE;
|
|
}
|
|
}
|
|
|
|
|
|
- pci_read_config_dword(dev, GPIOBASE, &base_addr_cfg);
|
|
|
|
- base_addr = 0;
|
|
|
|
- if (!(base_addr_cfg & (1 << 31)))
|
|
|
|
- dev_warn(&dev->dev, "Decode of the GPIO I/O range disabled\n");
|
|
|
|
- else
|
|
|
|
- base_addr = (unsigned short)base_addr_cfg;
|
|
|
|
|
|
+ res->start = base_addr;
|
|
|
|
+ res->end = base_addr + size - 1;
|
|
|
|
+ res->flags = IORESOURCE_IO;
|
|
|
|
|
|
- if (base_addr == 0) {
|
|
|
|
- dev_warn(&dev->dev, "I/O space for GPIO uninitialized\n");
|
|
|
|
- } else {
|
|
|
|
- lpc_sch_cells[cells++] = sch_gpio_cell;
|
|
|
|
- gpio_sch_resource.start = base_addr;
|
|
|
|
- if (id->device == PCI_DEVICE_ID_INTEL_CENTERTON_ILB)
|
|
|
|
- gpio_sch_resource.end = base_addr + GPIO_IO_SIZE_CENTERTON - 1;
|
|
|
|
- else
|
|
|
|
- gpio_sch_resource.end = base_addr + GPIO_IO_SIZE - 1;
|
|
|
|
- }
|
|
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
|
|
- if (id->device == PCI_DEVICE_ID_INTEL_ITC_LPC
|
|
|
|
- || id->device == PCI_DEVICE_ID_INTEL_CENTERTON_ILB) {
|
|
|
|
- pci_read_config_dword(dev, WDTBASE, &base_addr_cfg);
|
|
|
|
- base_addr = 0;
|
|
|
|
- if (!(base_addr_cfg & (1 << 31)))
|
|
|
|
- dev_warn(&dev->dev, "Decode of the WDT I/O range disabled\n");
|
|
|
|
- else
|
|
|
|
- base_addr = (unsigned short)base_addr_cfg;
|
|
|
|
- if (base_addr == 0)
|
|
|
|
- dev_warn(&dev->dev, "I/O space for WDT uninitialized\n");
|
|
|
|
- else {
|
|
|
|
- lpc_sch_cells[cells++] = wdt_sch_cell;
|
|
|
|
- wdt_sch_resource.start = base_addr;
|
|
|
|
- wdt_sch_resource.end = base_addr + WDT_IO_SIZE - 1;
|
|
|
|
- }
|
|
|
|
- }
|
|
|
|
|
|
+static int lpc_sch_populate_cell(struct pci_dev *pdev, int where,
|
|
|
|
+ const char *name, int size, int irq,
|
|
|
|
+ int id, struct mfd_cell *cell)
|
|
|
|
+{
|
|
|
|
+ struct resource *res;
|
|
|
|
+ int ret;
|
|
|
|
|
|
- if (WARN_ON(cells > ARRAY_SIZE(lpc_sch_cells))) {
|
|
|
|
- dev_err(&dev->dev, "Cell count exceeds array size");
|
|
|
|
- return -ENODEV;
|
|
|
|
- }
|
|
|
|
|
|
+ res = devm_kcalloc(&pdev->dev, 2, sizeof(*res), GFP_KERNEL);
|
|
|
|
+ if (!res)
|
|
|
|
+ return -ENOMEM;
|
|
|
|
+
|
|
|
|
+ ret = lpc_sch_get_io(pdev, where, name, res, size);
|
|
|
|
+ if (ret)
|
|
|
|
+ return ret;
|
|
|
|
+
|
|
|
|
+ memset(cell, 0, sizeof(*cell));
|
|
|
|
+
|
|
|
|
+ cell->name = name;
|
|
|
|
+ cell->resources = res;
|
|
|
|
+ cell->num_resources = 1;
|
|
|
|
+ cell->ignore_resource_conflicts = true;
|
|
|
|
+ cell->id = id;
|
|
|
|
+
|
|
|
|
+ /* Check if we need to add an IRQ resource */
|
|
|
|
+ if (irq < 0)
|
|
|
|
+ return 0;
|
|
|
|
+
|
|
|
|
+ res++;
|
|
|
|
+
|
|
|
|
+ res->start = irq;
|
|
|
|
+ res->end = irq;
|
|
|
|
+ res->flags = IORESOURCE_IRQ;
|
|
|
|
+
|
|
|
|
+ cell->num_resources++;
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static int lpc_sch_probe(struct pci_dev *dev, const struct pci_device_id *id)
|
|
|
|
+{
|
|
|
|
+ struct mfd_cell lpc_sch_cells[3];
|
|
|
|
+ struct lpc_sch_info *info = &sch_chipset_info[id->driver_data];
|
|
|
|
+ unsigned int cells = 0;
|
|
|
|
+ int ret;
|
|
|
|
+
|
|
|
|
+ ret = lpc_sch_populate_cell(dev, SMBASE, "isch_smbus",
|
|
|
|
+ info->io_size_smbus, -1,
|
|
|
|
+ id->device, &lpc_sch_cells[cells]);
|
|
|
|
+ if (ret < 0)
|
|
|
|
+ return ret;
|
|
|
|
+ if (ret == 0)
|
|
|
|
+ cells++;
|
|
|
|
+
|
|
|
|
+ ret = lpc_sch_populate_cell(dev, GPIOBASE, "sch_gpio",
|
|
|
|
+ info->io_size_gpio, info->irq_gpio,
|
|
|
|
+ id->device, &lpc_sch_cells[cells]);
|
|
|
|
+ if (ret < 0)
|
|
|
|
+ return ret;
|
|
|
|
+ if (ret == 0)
|
|
|
|
+ cells++;
|
|
|
|
+
|
|
|
|
+ ret = lpc_sch_populate_cell(dev, WDTBASE, "ie6xx_wdt",
|
|
|
|
+ info->io_size_wdt, -1,
|
|
|
|
+ id->device, &lpc_sch_cells[cells]);
|
|
|
|
+ if (ret < 0)
|
|
|
|
+ return ret;
|
|
|
|
+ if (ret == 0)
|
|
|
|
+ cells++;
|
|
|
|
|
|
if (cells == 0) {
|
|
if (cells == 0) {
|
|
dev_err(&dev->dev, "All decode registers disabled.\n");
|
|
dev_err(&dev->dev, "All decode registers disabled.\n");
|
|
return -ENODEV;
|
|
return -ENODEV;
|
|
}
|
|
}
|
|
|
|
|
|
- for (i = 0; i < cells; i++)
|
|
|
|
- lpc_sch_cells[i].id = id->device;
|
|
|
|
-
|
|
|
|
ret = mfd_add_devices(&dev->dev, 0, lpc_sch_cells, cells, NULL, 0, NULL);
|
|
ret = mfd_add_devices(&dev->dev, 0, lpc_sch_cells, cells, NULL, 0, NULL);
|
|
if (ret)
|
|
if (ret)
|
|
mfd_remove_devices(&dev->dev);
|
|
mfd_remove_devices(&dev->dev);
|