1 /* 2 * linux/drivers/misc/xillybus_of.c 3 * 4 * Copyright 2011 Xillybus Ltd, http://xillybus.com 5 * 6 * Driver for the Xillybus FPGA/host framework using Open Firmware. 7 * 8 * This program is free software; you can redistribute it and/or modify 9 * it under the smems of the GNU General Public License as published by 10 * the Free Software Foundation; version 2 of the License. 11 */ 12 13 #include <linux/module.h> 14 #include <linux/device.h> 15 #include <linux/slab.h> 16 #include <linux/platform_device.h> 17 #include <linux/of.h> 18 #include <linux/err.h> 19 #include "xillybus.h" 20 21 MODULE_DESCRIPTION("Xillybus driver for Open Firmware"); 22 MODULE_AUTHOR("Eli Billauer, Xillybus Ltd."); 23 MODULE_VERSION("1.06"); 24 MODULE_ALIAS("xillybus_of"); 25 MODULE_LICENSE("GPL v2"); 26 27 static const char xillyname[] = "xillybus_of"; 28 29 /* Match table for of_platform binding */ 30 static const struct of_device_id xillybus_of_match[] = { 31 { .compatible = "xillybus,xillybus-1.00.a", }, 32 { .compatible = "xlnx,xillybus-1.00.a", }, /* Deprecated */ 33 {} 34 }; 35 36 MODULE_DEVICE_TABLE(of, xillybus_of_match); 37 38 static void xilly_dma_sync_single_for_cpu_of(struct xilly_endpoint *ep, 39 dma_addr_t dma_handle, 40 size_t size, 41 int direction) 42 { 43 dma_sync_single_for_cpu(ep->dev, dma_handle, size, direction); 44 } 45 46 static void xilly_dma_sync_single_for_device_of(struct xilly_endpoint *ep, 47 dma_addr_t dma_handle, 48 size_t size, 49 int direction) 50 { 51 dma_sync_single_for_device(ep->dev, dma_handle, size, direction); 52 } 53 54 static void xilly_dma_sync_single_nop(struct xilly_endpoint *ep, 55 dma_addr_t dma_handle, 56 size_t size, 57 int direction) 58 { 59 } 60 61 static void xilly_of_unmap(void *ptr) 62 { 63 struct xilly_mapping *data = ptr; 64 65 dma_unmap_single(data->device, data->dma_addr, 66 data->size, data->direction); 67 68 kfree(ptr); 69 } 70 71 static int xilly_map_single_of(struct xilly_endpoint *ep, 72 void *ptr, 73 size_t size, 74 int direction, 75 dma_addr_t *ret_dma_handle 76 ) 77 { 78 dma_addr_t addr; 79 struct xilly_mapping *this; 80 81 this = kzalloc(sizeof(*this), GFP_KERNEL); 82 if (!this) 83 return -ENOMEM; 84 85 addr = dma_map_single(ep->dev, ptr, size, direction); 86 87 if (dma_mapping_error(ep->dev, addr)) { 88 kfree(this); 89 return -ENODEV; 90 } 91 92 this->device = ep->dev; 93 this->dma_addr = addr; 94 this->size = size; 95 this->direction = direction; 96 97 *ret_dma_handle = addr; 98 99 return devm_add_action_or_reset(ep->dev, xilly_of_unmap, this); 100 } 101 102 static struct xilly_endpoint_hardware of_hw = { 103 .owner = THIS_MODULE, 104 .hw_sync_sgl_for_cpu = xilly_dma_sync_single_for_cpu_of, 105 .hw_sync_sgl_for_device = xilly_dma_sync_single_for_device_of, 106 .map_single = xilly_map_single_of, 107 }; 108 109 static struct xilly_endpoint_hardware of_hw_coherent = { 110 .owner = THIS_MODULE, 111 .hw_sync_sgl_for_cpu = xilly_dma_sync_single_nop, 112 .hw_sync_sgl_for_device = xilly_dma_sync_single_nop, 113 .map_single = xilly_map_single_of, 114 }; 115 116 static int xilly_drv_probe(struct platform_device *op) 117 { 118 struct device *dev = &op->dev; 119 struct xilly_endpoint *endpoint; 120 int rc; 121 int irq; 122 struct resource *res; 123 struct xilly_endpoint_hardware *ephw = &of_hw; 124 125 if (of_property_read_bool(dev->of_node, "dma-coherent")) 126 ephw = &of_hw_coherent; 127 128 endpoint = xillybus_init_endpoint(NULL, dev, ephw); 129 130 if (!endpoint) 131 return -ENOMEM; 132 133 dev_set_drvdata(dev, endpoint); 134 135 res = platform_get_resource(op, IORESOURCE_MEM, 0); 136 endpoint->registers = devm_ioremap_resource(dev, res); 137 138 if (IS_ERR(endpoint->registers)) 139 return PTR_ERR(endpoint->registers); 140 141 irq = platform_get_irq(op, 0); 142 143 rc = devm_request_irq(dev, irq, xillybus_isr, 0, xillyname, endpoint); 144 145 if (rc) { 146 dev_err(endpoint->dev, 147 "Failed to register IRQ handler. Aborting.\n"); 148 return -ENODEV; 149 } 150 151 return xillybus_endpoint_discovery(endpoint); 152 } 153 154 static int xilly_drv_remove(struct platform_device *op) 155 { 156 struct device *dev = &op->dev; 157 struct xilly_endpoint *endpoint = dev_get_drvdata(dev); 158 159 xillybus_endpoint_remove(endpoint); 160 161 return 0; 162 } 163 164 static struct platform_driver xillybus_platform_driver = { 165 .probe = xilly_drv_probe, 166 .remove = xilly_drv_remove, 167 .driver = { 168 .name = xillyname, 169 .of_match_table = xillybus_of_match, 170 }, 171 }; 172 173 module_platform_driver(xillybus_platform_driver); 174