mirror of
https://github.com/rd-stuffs/msm-4.14.git
synced 2025-02-20 11:45:48 +08:00
staging: comedi: refactor dt3000 driver to remove forward declarations
Move the module_init/module_exit routines and the associated struct comedi_driver and other variables to the end of the source. This is more typical of how other drivers are written. Also, refactor a couple of the pci helper functions used during the attach. The removes the need for the forward declarations. Signed-off-by: H Hartley Sweeten <hsweeten@visionengravers.com> Cc: Ian Abbott <abbotti@mev.co.uk> Cc: Mori Hess <fmhess@users.sourceforge.net> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
H Hartley Sweeten
Greg Kroah-Hartman
parent
de9f2db41e
commit
15362c5ec4
@ -164,19 +164,6 @@ static const struct dt3k_boardtype dt3k_boardtypes[] = {
|
|||||||
#define n_dt3k_boards sizeof(dt3k_boardtypes)/sizeof(struct dt3k_boardtype)
|
#define n_dt3k_boards sizeof(dt3k_boardtypes)/sizeof(struct dt3k_boardtype)
|
||||||
#define this_board ((const struct dt3k_boardtype *)dev->board_ptr)
|
#define this_board ((const struct dt3k_boardtype *)dev->board_ptr)
|
||||||
|
|
||||||
static DEFINE_PCI_DEVICE_TABLE(dt3k_pci_table) = {
|
|
||||||
{ PCI_DEVICE(PCI_VENDOR_ID_DT, 0x0022) },
|
|
||||||
{ PCI_DEVICE(PCI_VENDOR_ID_DT, 0x0027) },
|
|
||||||
{ PCI_DEVICE(PCI_VENDOR_ID_DT, 0x0023) },
|
|
||||||
{ PCI_DEVICE(PCI_VENDOR_ID_DT, 0x0024) },
|
|
||||||
{ PCI_DEVICE(PCI_VENDOR_ID_DT, 0x0028) },
|
|
||||||
{ PCI_DEVICE(PCI_VENDOR_ID_DT, 0x0025) },
|
|
||||||
{ PCI_DEVICE(PCI_VENDOR_ID_DT, 0x0026) },
|
|
||||||
{ 0 }
|
|
||||||
};
|
|
||||||
|
|
||||||
MODULE_DEVICE_TABLE(pci, dt3k_pci_table);
|
|
||||||
|
|
||||||
#define DT3000_SIZE (4*0x1000)
|
#define DT3000_SIZE (4*0x1000)
|
||||||
|
|
||||||
/* dual-ported RAM location definitions */
|
/* dual-ported RAM location definitions */
|
||||||
@ -276,54 +263,6 @@ struct dt3k_private {
|
|||||||
|
|
||||||
#define devpriv ((struct dt3k_private *)dev->private)
|
#define devpriv ((struct dt3k_private *)dev->private)
|
||||||
|
|
||||||
static int dt3000_attach(struct comedi_device *dev,
|
|
||||||
struct comedi_devconfig *it);
|
|
||||||
static int dt3000_detach(struct comedi_device *dev);
|
|
||||||
static struct comedi_driver driver_dt3000 = {
|
|
||||||
.driver_name = "dt3000",
|
|
||||||
.module = THIS_MODULE,
|
|
||||||
.attach = dt3000_attach,
|
|
||||||
.detach = dt3000_detach,
|
|
||||||
};
|
|
||||||
|
|
||||||
static int __devinit driver_dt3000_pci_probe(struct pci_dev *dev,
|
|
||||||
const struct pci_device_id *ent)
|
|
||||||
{
|
|
||||||
return comedi_pci_auto_config(dev, &driver_dt3000);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __devexit driver_dt3000_pci_remove(struct pci_dev *dev)
|
|
||||||
{
|
|
||||||
comedi_pci_auto_unconfig(dev);
|
|
||||||
}
|
|
||||||
|
|
||||||
static struct pci_driver driver_dt3000_pci_driver = {
|
|
||||||
.id_table = dt3k_pci_table,
|
|
||||||
.probe = &driver_dt3000_pci_probe,
|
|
||||||
.remove = __devexit_p(&driver_dt3000_pci_remove)
|
|
||||||
};
|
|
||||||
|
|
||||||
static int __init driver_dt3000_init_module(void)
|
|
||||||
{
|
|
||||||
int retval;
|
|
||||||
|
|
||||||
retval = comedi_driver_register(&driver_dt3000);
|
|
||||||
if (retval < 0)
|
|
||||||
return retval;
|
|
||||||
|
|
||||||
driver_dt3000_pci_driver.name = (char *)driver_dt3000.driver_name;
|
|
||||||
return pci_register_driver(&driver_dt3000_pci_driver);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __exit driver_dt3000_cleanup_module(void)
|
|
||||||
{
|
|
||||||
pci_unregister_driver(&driver_dt3000_pci_driver);
|
|
||||||
comedi_driver_unregister(&driver_dt3000);
|
|
||||||
}
|
|
||||||
|
|
||||||
module_init(driver_dt3000_init_module);
|
|
||||||
module_exit(driver_dt3000_cleanup_module);
|
|
||||||
|
|
||||||
static void dt3k_ai_empty_fifo(struct comedi_device *dev,
|
static void dt3k_ai_empty_fifo(struct comedi_device *dev,
|
||||||
struct comedi_subdevice *s);
|
struct comedi_subdevice *s);
|
||||||
static int dt3k_ns_to_timer(unsigned int timer_base, unsigned int *arg,
|
static int dt3k_ns_to_timer(unsigned int timer_base, unsigned int *arg,
|
||||||
@ -841,7 +780,77 @@ static int dt3k_mem_insn_read(struct comedi_device *dev,
|
|||||||
return i;
|
return i;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int dt_pci_probe(struct comedi_device *dev, int bus, int slot);
|
static int setup_pci(struct comedi_device *dev)
|
||||||
|
{
|
||||||
|
resource_size_t addr;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
ret = comedi_pci_enable(devpriv->pci_dev, "dt3000");
|
||||||
|
if (ret < 0)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
addr = pci_resource_start(devpriv->pci_dev, 0);
|
||||||
|
devpriv->phys_addr = addr;
|
||||||
|
devpriv->io_addr = ioremap(devpriv->phys_addr, DT3000_SIZE);
|
||||||
|
if (!devpriv->io_addr)
|
||||||
|
return -ENOMEM;
|
||||||
|
#if DEBUG
|
||||||
|
printk("0x%08llx mapped to %p, ",
|
||||||
|
(unsigned long long)devpriv->phys_addr, devpriv->io_addr);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct pci_dev *dt_pci_find_device(struct pci_dev *from, int *board)
|
||||||
|
{
|
||||||
|
int i;
|
||||||
|
|
||||||
|
for (from = pci_get_device(PCI_VENDOR_ID_DT, PCI_ANY_ID, from);
|
||||||
|
from != NULL;
|
||||||
|
from = pci_get_device(PCI_VENDOR_ID_DT, PCI_ANY_ID, from)) {
|
||||||
|
for (i = 0; i < n_dt3k_boards; i++) {
|
||||||
|
if (from->device == dt3k_boardtypes[i].device_id) {
|
||||||
|
*board = i;
|
||||||
|
return from;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
printk
|
||||||
|
("unknown Data Translation PCI device found with device_id=0x%04x\n",
|
||||||
|
from->device);
|
||||||
|
}
|
||||||
|
*board = -1;
|
||||||
|
return from;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int dt_pci_probe(struct comedi_device *dev, int bus, int slot)
|
||||||
|
{
|
||||||
|
int board;
|
||||||
|
int ret;
|
||||||
|
struct pci_dev *pcidev;
|
||||||
|
|
||||||
|
pcidev = NULL;
|
||||||
|
while ((pcidev = dt_pci_find_device(pcidev, &board)) != NULL) {
|
||||||
|
if ((bus == 0 && slot == 0) ||
|
||||||
|
(pcidev->bus->number == bus &&
|
||||||
|
PCI_SLOT(pcidev->devfn) == slot)) {
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
devpriv->pci_dev = pcidev;
|
||||||
|
|
||||||
|
if (board >= 0)
|
||||||
|
dev->board_ptr = dt3k_boardtypes + board;
|
||||||
|
|
||||||
|
if (!devpriv->pci_dev)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
ret = setup_pci(dev);
|
||||||
|
if (ret < 0)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
static int dt3000_attach(struct comedi_device *dev, struct comedi_devconfig *it)
|
static int dt3000_attach(struct comedi_device *dev, struct comedi_devconfig *it)
|
||||||
{
|
{
|
||||||
@ -949,85 +958,65 @@ static int dt3000_detach(struct comedi_device *dev)
|
|||||||
if (devpriv->io_addr)
|
if (devpriv->io_addr)
|
||||||
iounmap(devpriv->io_addr);
|
iounmap(devpriv->io_addr);
|
||||||
}
|
}
|
||||||
/* XXX */
|
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static struct pci_dev *dt_pci_find_device(struct pci_dev *from, int *board);
|
static struct comedi_driver driver_dt3000 = {
|
||||||
static int setup_pci(struct comedi_device *dev);
|
.driver_name = "dt3000",
|
||||||
|
.module = THIS_MODULE,
|
||||||
|
.attach = dt3000_attach,
|
||||||
|
.detach = dt3000_detach,
|
||||||
|
};
|
||||||
|
|
||||||
static int dt_pci_probe(struct comedi_device *dev, int bus, int slot)
|
static int __devinit driver_dt3000_pci_probe(struct pci_dev *dev,
|
||||||
|
const struct pci_device_id *ent)
|
||||||
{
|
{
|
||||||
int board;
|
return comedi_pci_auto_config(dev, &driver_dt3000);
|
||||||
int ret;
|
|
||||||
struct pci_dev *pcidev;
|
|
||||||
|
|
||||||
pcidev = NULL;
|
|
||||||
while ((pcidev = dt_pci_find_device(pcidev, &board)) != NULL) {
|
|
||||||
if ((bus == 0 && slot == 0) ||
|
|
||||||
(pcidev->bus->number == bus &&
|
|
||||||
PCI_SLOT(pcidev->devfn) == slot)) {
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
devpriv->pci_dev = pcidev;
|
|
||||||
|
|
||||||
if (board >= 0)
|
|
||||||
dev->board_ptr = dt3k_boardtypes + board;
|
|
||||||
|
|
||||||
if (!devpriv->pci_dev)
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
ret = setup_pci(dev);
|
|
||||||
if (ret < 0)
|
|
||||||
return ret;
|
|
||||||
|
|
||||||
return 1;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int setup_pci(struct comedi_device *dev)
|
static void __devexit driver_dt3000_pci_remove(struct pci_dev *dev)
|
||||||
{
|
{
|
||||||
resource_size_t addr;
|
comedi_pci_auto_unconfig(dev);
|
||||||
int ret;
|
|
||||||
|
|
||||||
ret = comedi_pci_enable(devpriv->pci_dev, "dt3000");
|
|
||||||
if (ret < 0)
|
|
||||||
return ret;
|
|
||||||
|
|
||||||
addr = pci_resource_start(devpriv->pci_dev, 0);
|
|
||||||
devpriv->phys_addr = addr;
|
|
||||||
devpriv->io_addr = ioremap(devpriv->phys_addr, DT3000_SIZE);
|
|
||||||
if (!devpriv->io_addr)
|
|
||||||
return -ENOMEM;
|
|
||||||
#if DEBUG
|
|
||||||
printk("0x%08llx mapped to %p, ",
|
|
||||||
(unsigned long long)devpriv->phys_addr, devpriv->io_addr);
|
|
||||||
#endif
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static struct pci_dev *dt_pci_find_device(struct pci_dev *from, int *board)
|
static DEFINE_PCI_DEVICE_TABLE(dt3k_pci_table) = {
|
||||||
{
|
{ PCI_DEVICE(PCI_VENDOR_ID_DT, 0x0022) },
|
||||||
int i;
|
{ PCI_DEVICE(PCI_VENDOR_ID_DT, 0x0027) },
|
||||||
|
{ PCI_DEVICE(PCI_VENDOR_ID_DT, 0x0023) },
|
||||||
|
{ PCI_DEVICE(PCI_VENDOR_ID_DT, 0x0024) },
|
||||||
|
{ PCI_DEVICE(PCI_VENDOR_ID_DT, 0x0028) },
|
||||||
|
{ PCI_DEVICE(PCI_VENDOR_ID_DT, 0x0025) },
|
||||||
|
{ PCI_DEVICE(PCI_VENDOR_ID_DT, 0x0026) },
|
||||||
|
{ 0 }
|
||||||
|
};
|
||||||
|
MODULE_DEVICE_TABLE(pci, dt3k_pci_table);
|
||||||
|
|
||||||
for (from = pci_get_device(PCI_VENDOR_ID_DT, PCI_ANY_ID, from);
|
static struct pci_driver driver_dt3000_pci_driver = {
|
||||||
from != NULL;
|
.id_table = dt3k_pci_table,
|
||||||
from = pci_get_device(PCI_VENDOR_ID_DT, PCI_ANY_ID, from)) {
|
.probe = driver_dt3000_pci_probe,
|
||||||
for (i = 0; i < n_dt3k_boards; i++) {
|
.remove = __devexit_p(driver_dt3000_pci_remove),
|
||||||
if (from->device == dt3k_boardtypes[i].device_id) {
|
};
|
||||||
*board = i;
|
|
||||||
return from;
|
static int __init driver_dt3000_init_module(void)
|
||||||
}
|
{
|
||||||
}
|
int retval;
|
||||||
printk
|
|
||||||
("unknown Data Translation PCI device found with device_id=0x%04x\n",
|
retval = comedi_driver_register(&driver_dt3000);
|
||||||
from->device);
|
if (retval < 0)
|
||||||
}
|
return retval;
|
||||||
*board = -1;
|
|
||||||
return from;
|
driver_dt3000_pci_driver.name = (char *)driver_dt3000.driver_name;
|
||||||
|
return pci_register_driver(&driver_dt3000_pci_driver);
|
||||||
}
|
}
|
||||||
|
module_init(driver_dt3000_init_module);
|
||||||
|
|
||||||
|
static void __exit driver_dt3000_cleanup_module(void)
|
||||||
|
{
|
||||||
|
pci_unregister_driver(&driver_dt3000_pci_driver);
|
||||||
|
comedi_driver_unregister(&driver_dt3000);
|
||||||
|
}
|
||||||
|
module_exit(driver_dt3000_cleanup_module);
|
||||||
|
|
||||||
MODULE_AUTHOR("Comedi http://www.comedi.org");
|
MODULE_AUTHOR("Comedi http://www.comedi.org");
|
||||||
MODULE_DESCRIPTION("Comedi low-level driver");
|
MODULE_DESCRIPTION("Comedi low-level driver");
|
||||||
|
|||||||
Loading…
x
Reference in New Issue
Block a user