|
@@ -14,16 +14,14 @@
|
|
|
#include <linux/module.h>
|
|
|
#include <linux/init.h>
|
|
|
#include <linux/interrupt.h>
|
|
|
-#include <linux/platform_device.h>
|
|
|
-
|
|
|
-#include <linux/of_platform.h>
|
|
|
-#include <linux/of_device.h>
|
|
|
-#include <linux/of_spi.h>
|
|
|
|
|
|
#include <linux/spi/spi.h>
|
|
|
#include <linux/spi/spi_bitbang.h>
|
|
|
#include <linux/io.h>
|
|
|
|
|
|
+#include "xilinx_spi.h"
|
|
|
+#include <linux/spi/xilinx_spi.h>
|
|
|
+
|
|
|
#define XILINX_SPI_NAME "xilinx_spi"
|
|
|
|
|
|
/* Register definitions as per "OPB Serial Peripheral Interface (SPI) (v1.00e)
|
|
@@ -78,7 +76,7 @@ struct xilinx_spi {
|
|
|
/* bitbang has to be first */
|
|
|
struct spi_bitbang bitbang;
|
|
|
struct completion done;
|
|
|
-
|
|
|
+ struct resource mem; /* phys mem */
|
|
|
void __iomem *regs; /* virt. address of the control registers */
|
|
|
|
|
|
u32 irq;
|
|
@@ -284,40 +282,22 @@ static irqreturn_t xilinx_spi_irq(int irq, void *dev_id)
|
|
|
return IRQ_HANDLED;
|
|
|
}
|
|
|
|
|
|
-static int __init xilinx_spi_of_probe(struct of_device *ofdev,
|
|
|
- const struct of_device_id *match)
|
|
|
+struct spi_master *xilinx_spi_init(struct device *dev, struct resource *mem,
|
|
|
+ u32 irq, s16 bus_num)
|
|
|
{
|
|
|
struct spi_master *master;
|
|
|
struct xilinx_spi *xspi;
|
|
|
- struct resource r_irq_struct;
|
|
|
- struct resource r_mem_struct;
|
|
|
-
|
|
|
- struct resource *r_irq = &r_irq_struct;
|
|
|
- struct resource *r_mem = &r_mem_struct;
|
|
|
- int rc = 0;
|
|
|
- const u32 *prop;
|
|
|
- int len;
|
|
|
-
|
|
|
- /* Get resources(memory, IRQ) associated with the device */
|
|
|
- master = spi_alloc_master(&ofdev->dev, sizeof(struct xilinx_spi));
|
|
|
+ struct xspi_platform_data *pdata = dev->platform_data;
|
|
|
+ int ret;
|
|
|
|
|
|
- if (master == NULL) {
|
|
|
- return -ENOMEM;
|
|
|
- }
|
|
|
-
|
|
|
- dev_set_drvdata(&ofdev->dev, master);
|
|
|
-
|
|
|
- rc = of_address_to_resource(ofdev->node, 0, r_mem);
|
|
|
- if (rc) {
|
|
|
- dev_warn(&ofdev->dev, "invalid address\n");
|
|
|
- goto put_master;
|
|
|
+ if (!pdata) {
|
|
|
+ dev_err(dev, "No platform data attached\n");
|
|
|
+ return NULL;
|
|
|
}
|
|
|
|
|
|
- rc = of_irq_to_resource(ofdev->node, 0, r_irq);
|
|
|
- if (rc == NO_IRQ) {
|
|
|
- dev_warn(&ofdev->dev, "no IRQ found\n");
|
|
|
- goto put_master;
|
|
|
- }
|
|
|
+ master = spi_alloc_master(dev, sizeof(struct xilinx_spi));
|
|
|
+ if (!master)
|
|
|
+ return NULL;
|
|
|
|
|
|
/* the spi->mode bits understood by this driver: */
|
|
|
master->mode_bits = SPI_CPOL | SPI_CPHA;
|
|
@@ -330,128 +310,67 @@ static int __init xilinx_spi_of_probe(struct of_device *ofdev,
|
|
|
xspi->bitbang.master->setup = xilinx_spi_setup;
|
|
|
init_completion(&xspi->done);
|
|
|
|
|
|
- xspi->irq = r_irq->start;
|
|
|
-
|
|
|
- if (!request_mem_region(r_mem->start,
|
|
|
- r_mem->end - r_mem->start + 1, XILINX_SPI_NAME)) {
|
|
|
- rc = -ENXIO;
|
|
|
- dev_warn(&ofdev->dev, "memory request failure\n");
|
|
|
+ if (!request_mem_region(mem->start, resource_size(mem),
|
|
|
+ XILINX_SPI_NAME))
|
|
|
goto put_master;
|
|
|
- }
|
|
|
|
|
|
- xspi->regs = ioremap(r_mem->start, r_mem->end - r_mem->start + 1);
|
|
|
+ xspi->regs = ioremap(mem->start, resource_size(mem));
|
|
|
if (xspi->regs == NULL) {
|
|
|
- rc = -ENOMEM;
|
|
|
- dev_warn(&ofdev->dev, "ioremap failure\n");
|
|
|
- goto release_mem;
|
|
|
+ dev_warn(dev, "ioremap failure\n");
|
|
|
+ goto map_failed;
|
|
|
}
|
|
|
- xspi->irq = r_irq->start;
|
|
|
|
|
|
- /* dynamic bus assignment */
|
|
|
- master->bus_num = -1;
|
|
|
+ master->bus_num = bus_num;
|
|
|
+ master->num_chipselect = pdata->num_chipselect;
|
|
|
|
|
|
- /* number of slave select bits is required */
|
|
|
- prop = of_get_property(ofdev->node, "xlnx,num-ss-bits", &len);
|
|
|
- if (!prop || len < sizeof(*prop)) {
|
|
|
- dev_warn(&ofdev->dev, "no 'xlnx,num-ss-bits' property\n");
|
|
|
- goto unmap_io;
|
|
|
- }
|
|
|
- master->num_chipselect = *prop;
|
|
|
+ xspi->mem = *mem;
|
|
|
+ xspi->irq = irq;
|
|
|
|
|
|
/* SPI controller initializations */
|
|
|
xspi_init_hw(xspi->regs);
|
|
|
|
|
|
/* Register for SPI Interrupt */
|
|
|
- rc = request_irq(xspi->irq, xilinx_spi_irq, 0, XILINX_SPI_NAME, xspi);
|
|
|
- if (rc != 0) {
|
|
|
- dev_warn(&ofdev->dev, "irq request failure: %d\n", xspi->irq);
|
|
|
+ ret = request_irq(xspi->irq, xilinx_spi_irq, 0, XILINX_SPI_NAME, xspi);
|
|
|
+ if (ret)
|
|
|
goto unmap_io;
|
|
|
- }
|
|
|
|
|
|
- rc = spi_bitbang_start(&xspi->bitbang);
|
|
|
- if (rc != 0) {
|
|
|
- dev_err(&ofdev->dev, "spi_bitbang_start FAILED\n");
|
|
|
+ ret = spi_bitbang_start(&xspi->bitbang);
|
|
|
+ if (ret) {
|
|
|
+ dev_err(dev, "spi_bitbang_start FAILED\n");
|
|
|
goto free_irq;
|
|
|
}
|
|
|
|
|
|
- dev_info(&ofdev->dev, "at 0x%08X mapped to 0x%08X, irq=%d\n",
|
|
|
- (unsigned int)r_mem->start, (u32)xspi->regs, xspi->irq);
|
|
|
-
|
|
|
- /* Add any subnodes on the SPI bus */
|
|
|
- of_register_spi_devices(master, ofdev->node);
|
|
|
-
|
|
|
- return rc;
|
|
|
+ dev_info(dev, "at 0x%08X mapped to 0x%08X, irq=%d\n",
|
|
|
+ (u32)mem->start, (u32)xspi->regs, xspi->irq);
|
|
|
+ return master;
|
|
|
|
|
|
free_irq:
|
|
|
free_irq(xspi->irq, xspi);
|
|
|
unmap_io:
|
|
|
iounmap(xspi->regs);
|
|
|
-release_mem:
|
|
|
- release_mem_region(r_mem->start, resource_size(r_mem));
|
|
|
+map_failed:
|
|
|
+ release_mem_region(mem->start, resource_size(mem));
|
|
|
put_master:
|
|
|
spi_master_put(master);
|
|
|
- return rc;
|
|
|
+ return NULL;
|
|
|
}
|
|
|
+EXPORT_SYMBOL(xilinx_spi_init);
|
|
|
|
|
|
-static int __devexit xilinx_spi_remove(struct of_device *ofdev)
|
|
|
+void xilinx_spi_deinit(struct spi_master *master)
|
|
|
{
|
|
|
struct xilinx_spi *xspi;
|
|
|
- struct spi_master *master;
|
|
|
- struct resource r_mem;
|
|
|
|
|
|
- master = platform_get_drvdata(ofdev);
|
|
|
xspi = spi_master_get_devdata(master);
|
|
|
|
|
|
spi_bitbang_stop(&xspi->bitbang);
|
|
|
free_irq(xspi->irq, xspi);
|
|
|
iounmap(xspi->regs);
|
|
|
- if (!of_address_to_resource(ofdev->node, 0, &r_mem))
|
|
|
- release_mem_region(r_mem.start, resource_size(&r_mem));
|
|
|
- dev_set_drvdata(&ofdev->dev, 0);
|
|
|
- spi_master_put(xspi->bitbang.master);
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-/* work with hotplug and coldplug */
|
|
|
-MODULE_ALIAS("platform:" XILINX_SPI_NAME);
|
|
|
-
|
|
|
-static int __exit xilinx_spi_of_remove(struct of_device *op)
|
|
|
-{
|
|
|
- return xilinx_spi_remove(op);
|
|
|
-}
|
|
|
|
|
|
-static struct of_device_id xilinx_spi_of_match[] = {
|
|
|
- { .compatible = "xlnx,xps-spi-2.00.a", },
|
|
|
- { .compatible = "xlnx,xps-spi-2.00.b", },
|
|
|
- {}
|
|
|
-};
|
|
|
-
|
|
|
-MODULE_DEVICE_TABLE(of, xilinx_spi_of_match);
|
|
|
-
|
|
|
-static struct of_platform_driver xilinx_spi_of_driver = {
|
|
|
- .owner = THIS_MODULE,
|
|
|
- .name = "xilinx-xps-spi",
|
|
|
- .match_table = xilinx_spi_of_match,
|
|
|
- .probe = xilinx_spi_of_probe,
|
|
|
- .remove = __exit_p(xilinx_spi_of_remove),
|
|
|
- .driver = {
|
|
|
- .name = "xilinx-xps-spi",
|
|
|
- .owner = THIS_MODULE,
|
|
|
- },
|
|
|
-};
|
|
|
-
|
|
|
-static int __init xilinx_spi_init(void)
|
|
|
-{
|
|
|
- return of_register_platform_driver(&xilinx_spi_of_driver);
|
|
|
+ release_mem_region(xspi->mem.start, resource_size(&xspi->mem));
|
|
|
+ spi_master_put(xspi->bitbang.master);
|
|
|
}
|
|
|
-module_init(xilinx_spi_init);
|
|
|
+EXPORT_SYMBOL(xilinx_spi_deinit);
|
|
|
|
|
|
-static void __exit xilinx_spi_exit(void)
|
|
|
-{
|
|
|
- of_unregister_platform_driver(&xilinx_spi_of_driver);
|
|
|
-}
|
|
|
-module_exit(xilinx_spi_exit);
|
|
|
MODULE_AUTHOR("MontaVista Software, Inc. <source@mvista.com>");
|
|
|
MODULE_DESCRIPTION("Xilinx SPI driver");
|
|
|
MODULE_LICENSE("GPL");
|