forked from luck/tmp_suning_uos_patched
mfd: Janz CMOD-IO PCI MODULbus Carrier Board support
The Janz CMOD-IO PCI MODULbus carrier board is a PCI to MODULbus bridge, which may host many different types of MODULbus daughterboards, including CAN and GPIO controllers. Signed-off-by: Ira W. Snyder <iws@ovro.caltech.edu> Reviewed-by: Wolfgang Grandegger <wg@grandegger.com> Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
This commit is contained in:
Ira W. Snyder
Samuel Ortiz
parent
165bce9783
commit
bd3581323c
|
|
@ -418,6 +418,16 @@ config MFD_RDC321X
|
|||
southbridge which provides access to GPIOs and Watchdog using the
|
||||
southbridge PCI device configuration space.
|
||||
|
||||
config MFD_JANZ_CMODIO
|
||||
tristate "Support for Janz CMOD-IO PCI MODULbus Carrier Board"
|
||||
select MFD_CORE
|
||||
depends on PCI
|
||||
help
|
||||
This is the core driver for the Janz CMOD-IO PCI MODULbus
|
||||
carrier board. This device is a PCI to MODULbus bridge which may
|
||||
host many different types of MODULbus daughterboards, including
|
||||
CAN and GPIO controllers.
|
||||
|
||||
endmenu
|
||||
|
||||
menu "Multimedia Capabilities Port drivers"
|
||||
|
|
|
|||
|
|
@ -65,3 +65,4 @@ obj-$(CONFIG_MFD_TIMBERDALE) += timberdale.o
|
|||
obj-$(CONFIG_PMIC_ADP5520) += adp5520.o
|
||||
obj-$(CONFIG_LPC_SCH) += lpc_sch.o
|
||||
obj-$(CONFIG_MFD_RDC321X) += rdc321x-southbridge.o
|
||||
obj-$(CONFIG_MFD_JANZ_CMODIO) += janz-cmodio.o
|
||||
|
|
|
|||
304
drivers/mfd/janz-cmodio.c
Normal file
304
drivers/mfd/janz-cmodio.c
Normal file
|
|
@ -0,0 +1,304 @@
|
|||
/*
|
||||
* Janz CMOD-IO MODULbus Carrier Board PCI Driver
|
||||
*
|
||||
* Copyright (c) 2010 Ira W. Snyder <iws@ovro.caltech.edu>
|
||||
*
|
||||
* Lots of inspiration and code was copied from drivers/mfd/sm501.c
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the
|
||||
* Free Software Foundation; either version 2 of the License, or (at your
|
||||
* option) any later version.
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/pci.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/mfd/core.h>
|
||||
|
||||
#include <linux/mfd/janz.h>
|
||||
|
||||
#define DRV_NAME "janz-cmodio"
|
||||
|
||||
/* Size of each MODULbus module in PCI BAR4 */
|
||||
#define CMODIO_MODULBUS_SIZE 0x200
|
||||
|
||||
/* Maximum number of MODULbus modules on a CMOD-IO carrier board */
|
||||
#define CMODIO_MAX_MODULES 4
|
||||
|
||||
/* Module Parameters */
|
||||
static unsigned int num_modules = CMODIO_MAX_MODULES;
|
||||
static unsigned char *modules[CMODIO_MAX_MODULES] = {
|
||||
"empty", "empty", "empty", "empty",
|
||||
};
|
||||
|
||||
module_param_array(modules, charp, &num_modules, S_IRUGO);
|
||||
MODULE_PARM_DESC(modules, "MODULbus modules attached to the carrier board");
|
||||
|
||||
/* Unique Device Id */
|
||||
static unsigned int cmodio_id;
|
||||
|
||||
struct cmodio_device {
|
||||
/* Parent PCI device */
|
||||
struct pci_dev *pdev;
|
||||
|
||||
/* PLX control registers */
|
||||
struct janz_cmodio_onboard_regs __iomem *ctrl;
|
||||
|
||||
/* hex switch position */
|
||||
u8 hex;
|
||||
|
||||
/* mfd-core API */
|
||||
struct mfd_cell cells[CMODIO_MAX_MODULES];
|
||||
struct resource resources[3 * CMODIO_MAX_MODULES];
|
||||
struct janz_platform_data pdata[CMODIO_MAX_MODULES];
|
||||
};
|
||||
|
||||
/*
|
||||
* Subdevices using the mfd-core API
|
||||
*/
|
||||
|
||||
static int __devinit cmodio_setup_subdevice(struct cmodio_device *priv,
|
||||
char *name, unsigned int devno,
|
||||
unsigned int modno)
|
||||
{
|
||||
struct janz_platform_data *pdata;
|
||||
struct mfd_cell *cell;
|
||||
struct resource *res;
|
||||
struct pci_dev *pci;
|
||||
|
||||
pci = priv->pdev;
|
||||
cell = &priv->cells[devno];
|
||||
res = &priv->resources[devno * 3];
|
||||
pdata = &priv->pdata[devno];
|
||||
|
||||
cell->name = name;
|
||||
cell->resources = res;
|
||||
cell->num_resources = 3;
|
||||
|
||||
/* Setup the subdevice ID -- must be unique */
|
||||
cell->id = cmodio_id++;
|
||||
|
||||
/* Add platform data */
|
||||
pdata->modno = modno;
|
||||
cell->platform_data = pdata;
|
||||
cell->data_size = sizeof(*pdata);
|
||||
|
||||
/* MODULbus registers -- PCI BAR3 is big-endian MODULbus access */
|
||||
res->flags = IORESOURCE_MEM;
|
||||
res->parent = &pci->resource[3];
|
||||
res->start = pci->resource[3].start + (CMODIO_MODULBUS_SIZE * modno);
|
||||
res->end = res->start + CMODIO_MODULBUS_SIZE - 1;
|
||||
res++;
|
||||
|
||||
/* PLX Control Registers -- PCI BAR4 is interrupt and other registers */
|
||||
res->flags = IORESOURCE_MEM;
|
||||
res->parent = &pci->resource[4];
|
||||
res->start = pci->resource[4].start;
|
||||
res->end = pci->resource[4].end;
|
||||
res++;
|
||||
|
||||
/*
|
||||
* IRQ
|
||||
*
|
||||
* The start and end fields are used as an offset to the irq_base
|
||||
* parameter passed into the mfd_add_devices() function call. All
|
||||
* devices share the same IRQ.
|
||||
*/
|
||||
res->flags = IORESOURCE_IRQ;
|
||||
res->parent = NULL;
|
||||
res->start = 0;
|
||||
res->end = 0;
|
||||
res++;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Probe each submodule using kernel parameters */
|
||||
static int __devinit cmodio_probe_submodules(struct cmodio_device *priv)
|
||||
{
|
||||
struct pci_dev *pdev = priv->pdev;
|
||||
unsigned int num_probed = 0;
|
||||
char *name;
|
||||
int i;
|
||||
|
||||
for (i = 0; i < num_modules; i++) {
|
||||
name = modules[i];
|
||||
if (!strcmp(name, "") || !strcmp(name, "empty"))
|
||||
continue;
|
||||
|
||||
dev_dbg(&priv->pdev->dev, "MODULbus %d: name %s\n", i, name);
|
||||
cmodio_setup_subdevice(priv, name, num_probed, i);
|
||||
num_probed++;
|
||||
}
|
||||
|
||||
/* print an error message if no modules were probed */
|
||||
if (num_probed == 0) {
|
||||
dev_err(&priv->pdev->dev, "no MODULbus modules specified, "
|
||||
"please set the ``modules'' kernel "
|
||||
"parameter according to your "
|
||||
"hardware configuration\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
return mfd_add_devices(&pdev->dev, 0, priv->cells,
|
||||
num_probed, NULL, pdev->irq);
|
||||
}
|
||||
|
||||
/*
|
||||
* SYSFS Attributes
|
||||
*/
|
||||
|
||||
static ssize_t mbus_show(struct device *dev, struct device_attribute *attr,
|
||||
char *buf)
|
||||
{
|
||||
struct cmodio_device *priv = dev_get_drvdata(dev);
|
||||
|
||||
return snprintf(buf, PAGE_SIZE, "%x\n", priv->hex);
|
||||
}
|
||||
|
||||
static DEVICE_ATTR(modulbus_number, S_IRUGO, mbus_show, NULL);
|
||||
|
||||
static struct attribute *cmodio_sysfs_attrs[] = {
|
||||
&dev_attr_modulbus_number.attr,
|
||||
NULL,
|
||||
};
|
||||
|
||||
static const struct attribute_group cmodio_sysfs_attr_group = {
|
||||
.attrs = cmodio_sysfs_attrs,
|
||||
};
|
||||
|
||||
/*
|
||||
* PCI Driver
|
||||
*/
|
||||
|
||||
static int __devinit cmodio_pci_probe(struct pci_dev *dev,
|
||||
const struct pci_device_id *id)
|
||||
{
|
||||
struct cmodio_device *priv;
|
||||
int ret;
|
||||
|
||||
priv = kzalloc(sizeof(*priv), GFP_KERNEL);
|
||||
if (!priv) {
|
||||
dev_err(&dev->dev, "unable to allocate private data\n");
|
||||
ret = -ENOMEM;
|
||||
goto out_return;
|
||||
}
|
||||
|
||||
pci_set_drvdata(dev, priv);
|
||||
priv->pdev = dev;
|
||||
|
||||
/* Hardware Initialization */
|
||||
ret = pci_enable_device(dev);
|
||||
if (ret) {
|
||||
dev_err(&dev->dev, "unable to enable device\n");
|
||||
goto out_free_priv;
|
||||
}
|
||||
|
||||
pci_set_master(dev);
|
||||
ret = pci_request_regions(dev, DRV_NAME);
|
||||
if (ret) {
|
||||
dev_err(&dev->dev, "unable to request regions\n");
|
||||
goto out_pci_disable_device;
|
||||
}
|
||||
|
||||
/* Onboard configuration registers */
|
||||
priv->ctrl = pci_ioremap_bar(dev, 4);
|
||||
if (!priv->ctrl) {
|
||||
dev_err(&dev->dev, "unable to remap onboard regs\n");
|
||||
ret = -ENOMEM;
|
||||
goto out_pci_release_regions;
|
||||
}
|
||||
|
||||
/* Read the hex switch on the carrier board */
|
||||
priv->hex = ioread8(&priv->ctrl->int_enable);
|
||||
|
||||
/* Add the MODULbus number (hex switch value) to the device's sysfs */
|
||||
ret = sysfs_create_group(&dev->dev.kobj, &cmodio_sysfs_attr_group);
|
||||
if (ret) {
|
||||
dev_err(&dev->dev, "unable to create sysfs attributes\n");
|
||||
goto out_unmap_ctrl;
|
||||
}
|
||||
|
||||
/*
|
||||
* Disable all interrupt lines, each submodule will enable its
|
||||
* own interrupt line if needed
|
||||
*/
|
||||
iowrite8(0xf, &priv->ctrl->int_disable);
|
||||
|
||||
/* Register drivers for all submodules */
|
||||
ret = cmodio_probe_submodules(priv);
|
||||
if (ret) {
|
||||
dev_err(&dev->dev, "unable to probe submodules\n");
|
||||
goto out_sysfs_remove_group;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
out_sysfs_remove_group:
|
||||
sysfs_remove_group(&dev->dev.kobj, &cmodio_sysfs_attr_group);
|
||||
out_unmap_ctrl:
|
||||
iounmap(priv->ctrl);
|
||||
out_pci_release_regions:
|
||||
pci_release_regions(dev);
|
||||
out_pci_disable_device:
|
||||
pci_disable_device(dev);
|
||||
out_free_priv:
|
||||
kfree(priv);
|
||||
out_return:
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void __devexit cmodio_pci_remove(struct pci_dev *dev)
|
||||
{
|
||||
struct cmodio_device *priv = pci_get_drvdata(dev);
|
||||
|
||||
mfd_remove_devices(&dev->dev);
|
||||
sysfs_remove_group(&dev->dev.kobj, &cmodio_sysfs_attr_group);
|
||||
iounmap(priv->ctrl);
|
||||
pci_release_regions(dev);
|
||||
pci_disable_device(dev);
|
||||
kfree(priv);
|
||||
}
|
||||
|
||||
#define PCI_VENDOR_ID_JANZ 0x13c3
|
||||
|
||||
/* The list of devices that this module will support */
|
||||
static DEFINE_PCI_DEVICE_TABLE(cmodio_pci_ids) = {
|
||||
{ PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9030, PCI_VENDOR_ID_JANZ, 0x0101 },
|
||||
{ PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9050, PCI_VENDOR_ID_JANZ, 0x0100 },
|
||||
{ 0, }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(pci, cmodio_pci_ids);
|
||||
|
||||
static struct pci_driver cmodio_pci_driver = {
|
||||
.name = DRV_NAME,
|
||||
.id_table = cmodio_pci_ids,
|
||||
.probe = cmodio_pci_probe,
|
||||
.remove = __devexit_p(cmodio_pci_remove),
|
||||
};
|
||||
|
||||
/*
|
||||
* Module Init / Exit
|
||||
*/
|
||||
|
||||
static int __init cmodio_init(void)
|
||||
{
|
||||
return pci_register_driver(&cmodio_pci_driver);
|
||||
}
|
||||
|
||||
static void __exit cmodio_exit(void)
|
||||
{
|
||||
pci_unregister_driver(&cmodio_pci_driver);
|
||||
}
|
||||
|
||||
MODULE_AUTHOR("Ira W. Snyder <iws@ovro.caltech.edu>");
|
||||
MODULE_DESCRIPTION("Janz CMOD-IO PCI MODULbus Carrier Board Driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
|
||||
module_init(cmodio_init);
|
||||
module_exit(cmodio_exit);
|
||||
54
include/linux/mfd/janz.h
Normal file
54
include/linux/mfd/janz.h
Normal file
|
|
@ -0,0 +1,54 @@
|
|||
/*
|
||||
* Common Definitions for Janz MODULbus devices
|
||||
*
|
||||
* Copyright (c) 2010 Ira W. Snyder <iws@ovro.caltech.edu>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms of the GNU General Public License as published by the
|
||||
* Free Software Foundation; either version 2 of the License, or (at your
|
||||
* option) any later version.
|
||||
*/
|
||||
|
||||
#ifndef JANZ_H
|
||||
#define JANZ_H
|
||||
|
||||
struct janz_platform_data {
|
||||
/* MODULbus Module Number */
|
||||
unsigned int modno;
|
||||
};
|
||||
|
||||
/* PLX bridge chip onboard registers */
|
||||
struct janz_cmodio_onboard_regs {
|
||||
u8 unused1;
|
||||
|
||||
/*
|
||||
* Read access: interrupt status
|
||||
* Write access: interrupt disable
|
||||
*/
|
||||
u8 int_disable;
|
||||
u8 unused2;
|
||||
|
||||
/*
|
||||
* Read access: MODULbus number (hex switch)
|
||||
* Write access: interrupt enable
|
||||
*/
|
||||
u8 int_enable;
|
||||
u8 unused3;
|
||||
|
||||
/* write-only */
|
||||
u8 reset_assert;
|
||||
u8 unused4;
|
||||
|
||||
/* write-only */
|
||||
u8 reset_deassert;
|
||||
u8 unused5;
|
||||
|
||||
/* read-write access to serial EEPROM */
|
||||
u8 eep;
|
||||
u8 unused6;
|
||||
|
||||
/* write-only access to EEPROM chip select */
|
||||
u8 enid;
|
||||
};
|
||||
|
||||
#endif /* JANZ_H */
|
||||
Loading…
Reference in New Issue
Block a user