![Jingoo Han](/assets/img/avatar_default.png)
The driver core clears the driver data to NULL after device_release or on probe failure. Thus, it is not needed to manually clear the device driver data to NULL. Signed-off-by: Jingoo Han <jg1.han@samsung.com> Signed-off-by: Brian Norris <computersforpeace@gmail.com>
144 lines
3.5 KiB
C
144 lines
3.5 KiB
C
/*
|
|
* NAND Flash Controller Device Driver
|
|
* Copyright © 2009-2010, Intel Corporation and its suppliers.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms and conditions of the GNU General Public License,
|
|
* version 2, as published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope it will be useful, but WITHOUT
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
* more details.
|
|
*/
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/slab.h>
|
|
|
|
#include "denali.h"
|
|
|
|
#define DENALI_NAND_NAME "denali-nand-pci"
|
|
|
|
/* List of platforms this NAND controller has be integrated into */
|
|
static DEFINE_PCI_DEVICE_TABLE(denali_pci_ids) = {
|
|
{ PCI_VDEVICE(INTEL, 0x0701), INTEL_CE4100 },
|
|
{ PCI_VDEVICE(INTEL, 0x0809), INTEL_MRST },
|
|
{ /* end: all zeroes */ }
|
|
};
|
|
MODULE_DEVICE_TABLE(pci, denali_pci_ids);
|
|
|
|
static int denali_pci_probe(struct pci_dev *dev, const struct pci_device_id *id)
|
|
{
|
|
int ret = -ENODEV;
|
|
resource_size_t csr_base, mem_base;
|
|
unsigned long csr_len, mem_len;
|
|
struct denali_nand_info *denali;
|
|
|
|
denali = kzalloc(sizeof(*denali), GFP_KERNEL);
|
|
if (!denali)
|
|
return -ENOMEM;
|
|
|
|
ret = pci_enable_device(dev);
|
|
if (ret) {
|
|
pr_err("Spectra: pci_enable_device failed.\n");
|
|
goto failed_alloc_memery;
|
|
}
|
|
|
|
if (id->driver_data == INTEL_CE4100) {
|
|
denali->platform = INTEL_CE4100;
|
|
mem_base = pci_resource_start(dev, 0);
|
|
mem_len = pci_resource_len(dev, 1);
|
|
csr_base = pci_resource_start(dev, 1);
|
|
csr_len = pci_resource_len(dev, 1);
|
|
} else {
|
|
denali->platform = INTEL_MRST;
|
|
csr_base = pci_resource_start(dev, 0);
|
|
csr_len = pci_resource_len(dev, 0);
|
|
mem_base = pci_resource_start(dev, 1);
|
|
mem_len = pci_resource_len(dev, 1);
|
|
if (!mem_len) {
|
|
mem_base = csr_base + csr_len;
|
|
mem_len = csr_len;
|
|
}
|
|
}
|
|
|
|
pci_set_master(dev);
|
|
denali->dev = &dev->dev;
|
|
denali->irq = dev->irq;
|
|
|
|
ret = pci_request_regions(dev, DENALI_NAND_NAME);
|
|
if (ret) {
|
|
pr_err("Spectra: Unable to request memory regions\n");
|
|
goto failed_enable_dev;
|
|
}
|
|
|
|
denali->flash_reg = ioremap_nocache(csr_base, csr_len);
|
|
if (!denali->flash_reg) {
|
|
pr_err("Spectra: Unable to remap memory region\n");
|
|
ret = -ENOMEM;
|
|
goto failed_req_regions;
|
|
}
|
|
|
|
denali->flash_mem = ioremap_nocache(mem_base, mem_len);
|
|
if (!denali->flash_mem) {
|
|
pr_err("Spectra: ioremap_nocache failed!");
|
|
ret = -ENOMEM;
|
|
goto failed_remap_reg;
|
|
}
|
|
|
|
ret = denali_init(denali);
|
|
if (ret)
|
|
goto failed_remap_mem;
|
|
|
|
pci_set_drvdata(dev, denali);
|
|
|
|
return 0;
|
|
|
|
failed_remap_mem:
|
|
iounmap(denali->flash_mem);
|
|
failed_remap_reg:
|
|
iounmap(denali->flash_reg);
|
|
failed_req_regions:
|
|
pci_release_regions(dev);
|
|
failed_enable_dev:
|
|
pci_disable_device(dev);
|
|
failed_alloc_memery:
|
|
kfree(denali);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/* driver exit point */
|
|
static void denali_pci_remove(struct pci_dev *dev)
|
|
{
|
|
struct denali_nand_info *denali = pci_get_drvdata(dev);
|
|
|
|
denali_remove(denali);
|
|
iounmap(denali->flash_reg);
|
|
iounmap(denali->flash_mem);
|
|
pci_release_regions(dev);
|
|
pci_disable_device(dev);
|
|
kfree(denali);
|
|
}
|
|
|
|
static struct pci_driver denali_pci_driver = {
|
|
.name = DENALI_NAND_NAME,
|
|
.id_table = denali_pci_ids,
|
|
.probe = denali_pci_probe,
|
|
.remove = denali_pci_remove,
|
|
};
|
|
|
|
static int denali_init_pci(void)
|
|
{
|
|
pr_info("Spectra MTD driver built on %s @ %s\n", __DATE__, __TIME__);
|
|
return pci_register_driver(&denali_pci_driver);
|
|
}
|
|
module_init(denali_init_pci);
|
|
|
|
static void denali_exit_pci(void)
|
|
{
|
|
pci_unregister_driver(&denali_pci_driver);
|
|
}
|
|
module_exit(denali_exit_pci);
|