2005-11-16 00:56:43 -07:00
|
|
|
/*
|
|
|
|
* IBM PowerPC IBM eBus Infrastructure Support.
|
|
|
|
*
|
|
|
|
* Copyright (c) 2005 IBM Corporation
|
2007-03-09 11:00:32 -07:00
|
|
|
* Joachim Fenkes <fenkes@de.ibm.com>
|
2005-11-16 00:56:43 -07:00
|
|
|
* Heiko J Schick <schickhj@de.ibm.com>
|
2007-03-09 10:56:46 -07:00
|
|
|
*
|
2005-11-16 00:56:43 -07:00
|
|
|
* All rights reserved.
|
|
|
|
*
|
2007-03-09 10:56:46 -07:00
|
|
|
* This source code is distributed under a dual license of GPL v2.0 and OpenIB
|
|
|
|
* BSD.
|
2005-11-16 00:56:43 -07:00
|
|
|
*
|
|
|
|
* OpenIB BSD License
|
|
|
|
*
|
2007-03-09 10:56:46 -07:00
|
|
|
* Redistribution and use in source and binary forms, with or without
|
|
|
|
* modification, are permitted provided that the following conditions are met:
|
2005-11-16 00:56:43 -07:00
|
|
|
*
|
2007-03-09 10:56:46 -07:00
|
|
|
* Redistributions of source code must retain the above copyright notice, this
|
|
|
|
* list of conditions and the following disclaimer.
|
2005-11-16 00:56:43 -07:00
|
|
|
*
|
2007-03-09 10:56:46 -07:00
|
|
|
* Redistributions in binary form must reproduce the above copyright notice,
|
|
|
|
* this list of conditions and the following disclaimer in the documentation
|
2005-11-16 00:56:43 -07:00
|
|
|
* and/or other materials
|
2007-03-09 10:56:46 -07:00
|
|
|
* provided with the distribution.
|
2005-11-16 00:56:43 -07:00
|
|
|
*
|
2007-03-09 10:56:46 -07:00
|
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
|
|
|
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
|
|
|
* LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
2005-11-16 00:56:43 -07:00
|
|
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
|
|
|
|
* BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
|
2007-03-09 10:56:46 -07:00
|
|
|
* IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
|
|
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
2005-11-16 00:56:43 -07:00
|
|
|
* POSSIBILITY OF SUCH DAMAGE.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/init.h>
|
|
|
|
#include <linux/console.h>
|
|
|
|
#include <linux/kobject.h>
|
|
|
|
#include <linux/dma-mapping.h>
|
|
|
|
#include <linux/interrupt.h>
|
|
|
|
#include <asm/ibmebus.h>
|
|
|
|
#include <asm/abs_addr.h>
|
|
|
|
|
2007-03-09 11:00:32 -07:00
|
|
|
static struct device ibmebus_bus_device = { /* fake "parent" device */
|
|
|
|
.bus_id = "ibmebus",
|
2005-11-16 00:56:43 -07:00
|
|
|
};
|
|
|
|
|
2007-03-09 11:00:32 -07:00
|
|
|
struct bus_type ibmebus_bus_type;
|
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
static void *ibmebus_alloc_coherent(struct device *dev,
|
|
|
|
size_t size,
|
|
|
|
dma_addr_t *dma_handle,
|
|
|
|
gfp_t flag)
|
|
|
|
{
|
|
|
|
void *mem;
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
mem = kmalloc(size, flag);
|
|
|
|
*dma_handle = (dma_addr_t)mem;
|
|
|
|
|
|
|
|
return mem;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void ibmebus_free_coherent(struct device *dev,
|
2007-03-09 10:56:46 -07:00
|
|
|
size_t size, void *vaddr,
|
2005-11-16 00:56:43 -07:00
|
|
|
dma_addr_t dma_handle)
|
|
|
|
{
|
|
|
|
kfree(vaddr);
|
|
|
|
}
|
|
|
|
|
|
|
|
static dma_addr_t ibmebus_map_single(struct device *dev,
|
|
|
|
void *ptr,
|
|
|
|
size_t size,
|
|
|
|
enum dma_data_direction direction)
|
|
|
|
{
|
|
|
|
return (dma_addr_t)(ptr);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void ibmebus_unmap_single(struct device *dev,
|
|
|
|
dma_addr_t dma_addr,
|
2007-03-09 10:56:46 -07:00
|
|
|
size_t size,
|
2005-11-16 00:56:43 -07:00
|
|
|
enum dma_data_direction direction)
|
|
|
|
{
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int ibmebus_map_sg(struct device *dev,
|
|
|
|
struct scatterlist *sg,
|
|
|
|
int nents, enum dma_data_direction direction)
|
|
|
|
{
|
|
|
|
int i;
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
for (i = 0; i < nents; i++) {
|
2007-03-09 10:56:46 -07:00
|
|
|
sg[i].dma_address = (dma_addr_t)page_address(sg[i].page)
|
2005-11-16 00:56:43 -07:00
|
|
|
+ sg[i].offset;
|
|
|
|
sg[i].dma_length = sg[i].length;
|
|
|
|
}
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
return nents;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void ibmebus_unmap_sg(struct device *dev,
|
|
|
|
struct scatterlist *sg,
|
|
|
|
int nents, enum dma_data_direction direction)
|
|
|
|
{
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int ibmebus_dma_supported(struct device *dev, u64 mask)
|
|
|
|
{
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
2006-11-10 23:25:02 -07:00
|
|
|
static struct dma_mapping_ops ibmebus_dma_ops = {
|
2005-11-16 00:56:43 -07:00
|
|
|
.alloc_coherent = ibmebus_alloc_coherent,
|
|
|
|
.free_coherent = ibmebus_free_coherent,
|
|
|
|
.map_single = ibmebus_map_single,
|
|
|
|
.unmap_single = ibmebus_unmap_single,
|
|
|
|
.map_sg = ibmebus_map_sg,
|
|
|
|
.unmap_sg = ibmebus_unmap_sg,
|
|
|
|
.dma_supported = ibmebus_dma_supported,
|
|
|
|
};
|
|
|
|
|
|
|
|
static int ibmebus_bus_probe(struct device *dev)
|
|
|
|
{
|
|
|
|
struct ibmebus_dev *ibmebusdev = to_ibmebus_dev(dev);
|
|
|
|
struct ibmebus_driver *ibmebusdrv = to_ibmebus_driver(dev->driver);
|
|
|
|
const struct of_device_id *id;
|
|
|
|
int error = -ENODEV;
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
if (!ibmebusdrv->probe)
|
|
|
|
return error;
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
id = of_match_device(ibmebusdrv->id_table, &ibmebusdev->ofdev);
|
|
|
|
if (id) {
|
|
|
|
error = ibmebusdrv->probe(ibmebusdev, id);
|
|
|
|
}
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
return error;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int ibmebus_bus_remove(struct device *dev)
|
|
|
|
{
|
|
|
|
struct ibmebus_dev *ibmebusdev = to_ibmebus_dev(dev);
|
|
|
|
struct ibmebus_driver *ibmebusdrv = to_ibmebus_driver(dev->driver);
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
if (ibmebusdrv->remove) {
|
|
|
|
return ibmebusdrv->remove(ibmebusdev);
|
|
|
|
}
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __devinit ibmebus_dev_release(struct device *dev)
|
|
|
|
{
|
|
|
|
of_node_put(to_ibmebus_dev(dev)->ofdev.node);
|
|
|
|
kfree(to_ibmebus_dev(dev));
|
|
|
|
}
|
|
|
|
|
2007-03-09 11:00:32 -07:00
|
|
|
static int __devinit ibmebus_register_device_common(
|
2006-07-11 23:35:54 -06:00
|
|
|
struct ibmebus_dev *dev, const char *name)
|
2005-11-16 00:56:43 -07:00
|
|
|
{
|
|
|
|
int err = 0;
|
|
|
|
|
2007-03-09 11:00:32 -07:00
|
|
|
dev->ofdev.dev.parent = &ibmebus_bus_device;
|
2005-11-16 00:56:43 -07:00
|
|
|
dev->ofdev.dev.bus = &ibmebus_bus_type;
|
|
|
|
dev->ofdev.dev.release = ibmebus_dev_release;
|
|
|
|
|
2006-11-10 23:25:02 -07:00
|
|
|
dev->ofdev.dev.archdata.of_node = dev->ofdev.node;
|
|
|
|
dev->ofdev.dev.archdata.dma_ops = &ibmebus_dma_ops;
|
|
|
|
dev->ofdev.dev.archdata.numa_node = of_node_to_nid(dev->ofdev.node);
|
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
/* An ibmebusdev is based on a of_device. We have to change the
|
2007-03-09 10:56:46 -07:00
|
|
|
* bus type to use our own DMA mapping operations.
|
|
|
|
*/
|
2005-11-16 00:56:43 -07:00
|
|
|
if ((err = of_device_register(&dev->ofdev)) != 0) {
|
|
|
|
printk(KERN_ERR "%s: failed to register device (%d).\n",
|
|
|
|
__FUNCTION__, err);
|
2007-03-09 11:00:32 -07:00
|
|
|
return -ENODEV;
|
2005-11-16 00:56:43 -07:00
|
|
|
}
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2007-03-09 11:00:32 -07:00
|
|
|
return 0;
|
2005-11-16 00:56:43 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
static struct ibmebus_dev* __devinit ibmebus_register_device_node(
|
|
|
|
struct device_node *dn)
|
|
|
|
{
|
|
|
|
struct ibmebus_dev *dev;
|
2007-08-29 10:15:17 -06:00
|
|
|
int i, len, bus_len;
|
2005-11-16 00:56:43 -07:00
|
|
|
|
2006-12-02 04:26:57 -07:00
|
|
|
dev = kzalloc(sizeof(struct ibmebus_dev), GFP_KERNEL);
|
2007-08-29 10:15:17 -06:00
|
|
|
if (!dev)
|
2007-03-09 11:00:32 -07:00
|
|
|
return ERR_PTR(-ENOMEM);
|
2005-11-16 00:56:43 -07:00
|
|
|
|
|
|
|
dev->ofdev.node = of_node_get(dn);
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2007-08-29 10:15:17 -06:00
|
|
|
len = strlen(dn->full_name + 1);
|
|
|
|
bus_len = min(len, BUS_ID_SIZE - 1);
|
|
|
|
memcpy(dev->ofdev.dev.bus_id, dn->full_name + 1
|
|
|
|
+ (len - bus_len), bus_len);
|
|
|
|
for (i = 0; i < bus_len; i++)
|
|
|
|
if (dev->ofdev.dev.bus_id[i] == '/')
|
|
|
|
dev->ofdev.dev.bus_id[i] = '_';
|
2005-11-16 00:56:43 -07:00
|
|
|
|
|
|
|
/* Register with generic device framework. */
|
2007-03-09 11:00:32 -07:00
|
|
|
if (ibmebus_register_device_common(dev, dn->name) != 0) {
|
2005-11-16 00:56:43 -07:00
|
|
|
kfree(dev);
|
2007-03-09 11:00:32 -07:00
|
|
|
return ERR_PTR(-ENODEV);
|
2005-11-16 00:56:43 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
return dev;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void ibmebus_probe_of_nodes(char* name)
|
|
|
|
{
|
|
|
|
struct device_node *dn = NULL;
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
while ((dn = of_find_node_by_name(dn, name))) {
|
2007-03-09 11:00:32 -07:00
|
|
|
if (IS_ERR(ibmebus_register_device_node(dn))) {
|
2005-11-16 00:56:43 -07:00
|
|
|
of_node_put(dn);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
}
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
of_node_put(dn);
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void ibmebus_add_devices_by_id(struct of_device_id *idt)
|
|
|
|
{
|
|
|
|
while (strlen(idt->name) > 0) {
|
|
|
|
ibmebus_probe_of_nodes(idt->name);
|
|
|
|
idt++;
|
|
|
|
}
|
|
|
|
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2007-03-22 10:00:46 -06:00
|
|
|
static int ibmebus_match_name(struct device *dev, void *data)
|
2005-11-16 00:56:43 -07:00
|
|
|
{
|
2007-03-09 11:00:32 -07:00
|
|
|
const struct ibmebus_dev *ebus_dev = to_ibmebus_dev(dev);
|
2007-04-03 06:26:41 -06:00
|
|
|
const char *name;
|
2007-03-09 11:00:32 -07:00
|
|
|
|
2007-04-03 06:26:41 -06:00
|
|
|
name = of_get_property(ebus_dev->ofdev.node, "name", NULL);
|
2007-03-09 11:00:32 -07:00
|
|
|
|
2007-04-03 06:26:41 -06:00
|
|
|
if (name && (strcmp(data, name) == 0))
|
2005-11-16 00:56:43 -07:00
|
|
|
return 1;
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int ibmebus_unregister_device(struct device *dev)
|
|
|
|
{
|
|
|
|
of_device_unregister(to_of_device(dev));
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void ibmebus_remove_devices_by_id(struct of_device_id *idt)
|
|
|
|
{
|
|
|
|
struct device *dev;
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
while (strlen(idt->name) > 0) {
|
2007-03-09 10:56:46 -07:00
|
|
|
while ((dev = bus_find_device(&ibmebus_bus_type, NULL,
|
2005-11-16 00:56:43 -07:00
|
|
|
(void*)idt->name,
|
2007-03-22 10:00:46 -06:00
|
|
|
ibmebus_match_name))) {
|
2005-11-16 00:56:43 -07:00
|
|
|
ibmebus_unregister_device(dev);
|
|
|
|
}
|
|
|
|
idt++;
|
|
|
|
}
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
int ibmebus_register_driver(struct ibmebus_driver *drv)
|
|
|
|
{
|
|
|
|
int err = 0;
|
|
|
|
|
|
|
|
drv->driver.name = drv->name;
|
|
|
|
drv->driver.bus = &ibmebus_bus_type;
|
|
|
|
drv->driver.probe = ibmebus_bus_probe;
|
|
|
|
drv->driver.remove = ibmebus_bus_remove;
|
|
|
|
|
|
|
|
if ((err = driver_register(&drv->driver) != 0))
|
|
|
|
return err;
|
|
|
|
|
2007-03-09 11:00:32 -07:00
|
|
|
/* remove all supported devices first, in case someone
|
|
|
|
* probed them manually before registering the driver */
|
|
|
|
ibmebus_remove_devices_by_id(drv->id_table);
|
2005-11-16 00:56:43 -07:00
|
|
|
ibmebus_add_devices_by_id(drv->id_table);
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(ibmebus_register_driver);
|
|
|
|
|
|
|
|
void ibmebus_unregister_driver(struct ibmebus_driver *drv)
|
2007-03-09 10:56:46 -07:00
|
|
|
{
|
2005-11-16 00:56:43 -07:00
|
|
|
driver_unregister(&drv->driver);
|
|
|
|
ibmebus_remove_devices_by_id(drv->id_table);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(ibmebus_unregister_driver);
|
|
|
|
|
|
|
|
int ibmebus_request_irq(struct ibmebus_dev *dev,
|
2007-03-09 10:56:46 -07:00
|
|
|
u32 ist,
|
2006-10-09 05:19:47 -06:00
|
|
|
irq_handler_t handler,
|
2005-11-16 00:56:43 -07:00
|
|
|
unsigned long irq_flags, const char * devname,
|
|
|
|
void *dev_id)
|
|
|
|
{
|
[PATCH] powerpc: fix trigger handling in the new irq code
This patch slightly reworks the new irq code to fix a small design error. I
removed the passing of the trigger to the map() calls entirely, it was not a
good idea to have one call do two different things. It also fixes a couple of
corner cases.
Mapping a linux virtual irq to a physical irq now does only that. Setting the
trigger is a different action which has a different call.
The main changes are:
- I no longer call host->ops->map() for an already mapped irq, I just return
the virtual number that was already mapped. It was called before to give an
opportunity to change the trigger, but that was causing issues as that could
happen while the interrupt was in use by a device, and because of the
trigger change, map would potentially muck around with things in a racy way.
That was causing much burden on a given's controller implementation of
map() to get it right. This is much simpler now. map() is only called on
the initial mapping of an irq, meaning that you know that this irq is _not_
being used. You can initialize the hardware if you want (though you don't
have to).
- Controllers that can handle different type of triggers (level/edge/etc...)
now implement the standard irq_chip->set_type() call as defined by the
generic code. That means that you can use the standard set_irq_type() to
configure an irq line manually if you wish or (though I don't like that
interface), pass explicit trigger flags to request_irq() as defined by the
generic kernel interfaces. Also, using those interfaces guarantees that
your controller set_type callback is called with the descriptor lock held,
thus providing locking against activity on the same interrupt (including
mask/unmask/etc...) automatically. A result is that, for example, MPIC's
own map() implementation calls irq_set_type(NONE) to configure the hardware
to the default triggers.
- To allow the above, the irq_map array entry for the new mapped interrupt
is now set before map() callback is called for the controller.
- The irq_create_of_mapping() (also used by irq_of_parse_and_map()) function
for mapping interrupts from the device-tree now also call the separate
set_irq_type(), and only does so if there is a change in the trigger type.
- While I was at it, I changed pci_read_irq_line() (which is the helper I
would expect most archs to use in their pcibios_fixup() to get the PCI
interrupt routing from the device tree) to also handle a fallback when the
DT mapping fails consisting of reading the PCI_INTERRUPT_PIN to know wether
the device has an interrupt at all, and the the PCI_INTERRUPT_LINE to get an
interrupt number from the device. That number is then mapped using the
default controller, and the trigger is set to level low. That default
behaviour works for several platforms that don't have a proper interrupt
tree like Pegasos. If it doesn't work for your platform, then either
provide a proper interrupt tree from the firmware so that fallback isn't
needed, or don't call pci_read_irq_line()
- Add back a bit that got dropped by my main rework patch for properly
clearing pending IPIs on pSeries when using a kexec
Signed-off-by: Benjamin Herrenschmidt <benh@kernel.crashing.org>
Cc: Paul Mackerras <paulus@samba.org>
Signed-off-by: Andrew Morton <akpm@osdl.org>
Signed-off-by: Linus Torvalds <torvalds@osdl.org>
2006-07-10 05:44:42 -06:00
|
|
|
unsigned int irq = irq_create_mapping(NULL, ist);
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
if (irq == NO_IRQ)
|
|
|
|
return -EINVAL;
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
return request_irq(irq, handler,
|
|
|
|
irq_flags, devname, dev_id);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(ibmebus_request_irq);
|
|
|
|
|
|
|
|
void ibmebus_free_irq(struct ibmebus_dev *dev, u32 ist, void *dev_id)
|
|
|
|
{
|
2006-07-03 05:36:01 -06:00
|
|
|
unsigned int irq = irq_find_mapping(NULL, ist);
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
free_irq(irq, dev_id);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(ibmebus_free_irq);
|
|
|
|
|
|
|
|
static int ibmebus_bus_match(struct device *dev, struct device_driver *drv)
|
2007-03-09 10:56:46 -07:00
|
|
|
{
|
2005-11-16 00:56:43 -07:00
|
|
|
const struct ibmebus_dev *ebus_dev = to_ibmebus_dev(dev);
|
|
|
|
struct ibmebus_driver *ebus_drv = to_ibmebus_driver(drv);
|
|
|
|
const struct of_device_id *ids = ebus_drv->id_table;
|
|
|
|
const struct of_device_id *found_id;
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
if (!ids)
|
|
|
|
return 0;
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
found_id = of_match_device(ids, &ebus_dev->ofdev);
|
|
|
|
if (found_id)
|
|
|
|
return 1;
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2007-03-09 11:00:32 -07:00
|
|
|
static ssize_t name_show(struct device *dev,
|
|
|
|
struct device_attribute *attr, char *buf)
|
|
|
|
{
|
|
|
|
struct ibmebus_dev *ebus_dev = to_ibmebus_dev(dev);
|
2007-04-03 06:26:41 -06:00
|
|
|
const char *name = of_get_property(ebus_dev->ofdev.node, "name", NULL);
|
2007-03-09 11:00:32 -07:00
|
|
|
return sprintf(buf, "%s\n", name);
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct device_attribute ibmebus_dev_attrs[] = {
|
|
|
|
__ATTR_RO(name),
|
|
|
|
__ATTR_NULL
|
|
|
|
};
|
|
|
|
|
2007-03-22 10:00:46 -06:00
|
|
|
static int ibmebus_match_path(struct device *dev, void *data)
|
2007-03-09 11:00:32 -07:00
|
|
|
{
|
2007-03-22 10:00:46 -06:00
|
|
|
int rc;
|
|
|
|
struct device_node *dn =
|
|
|
|
of_node_get(to_ibmebus_dev(dev)->ofdev.node);
|
2007-03-09 11:00:32 -07:00
|
|
|
|
2007-03-22 10:00:46 -06:00
|
|
|
rc = (dn->full_name && (strcasecmp((char*)data, dn->full_name) == 0));
|
2007-03-09 11:00:32 -07:00
|
|
|
|
2007-03-22 10:00:46 -06:00
|
|
|
of_node_put(dn);
|
|
|
|
return rc;
|
|
|
|
}
|
2007-03-09 11:00:32 -07:00
|
|
|
|
2007-03-22 10:00:46 -06:00
|
|
|
static char *ibmebus_chomp(const char *in, size_t count)
|
|
|
|
{
|
2007-08-23 17:45:08 -06:00
|
|
|
char *out = kmalloc(count + 1, GFP_KERNEL);
|
|
|
|
|
2007-03-22 10:00:46 -06:00
|
|
|
if (!out)
|
|
|
|
return NULL;
|
|
|
|
|
|
|
|
memcpy(out, in, count);
|
|
|
|
out[count] = '\0';
|
|
|
|
if (out[count - 1] == '\n')
|
|
|
|
out[count - 1] = '\0';
|
|
|
|
|
|
|
|
return out;
|
2007-03-09 11:00:32 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t ibmebus_store_probe(struct bus_type *bus,
|
|
|
|
const char *buf, size_t count)
|
|
|
|
{
|
|
|
|
struct device_node *dn = NULL;
|
|
|
|
struct ibmebus_dev *dev;
|
2007-03-22 10:00:46 -06:00
|
|
|
char *path;
|
|
|
|
ssize_t rc;
|
|
|
|
|
|
|
|
path = ibmebus_chomp(buf, count);
|
|
|
|
if (!path)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
if (bus_find_device(&ibmebus_bus_type, NULL, path,
|
2007-09-26 03:46:34 -06:00
|
|
|
ibmebus_match_path)) {
|
2007-03-22 10:00:46 -06:00
|
|
|
printk(KERN_WARNING "%s: %s has already been probed\n",
|
|
|
|
__FUNCTION__, path);
|
2007-09-26 03:46:34 -06:00
|
|
|
rc = -EEXIST;
|
2007-03-22 10:00:46 -06:00
|
|
|
goto out;
|
2007-03-09 11:00:32 -07:00
|
|
|
}
|
|
|
|
|
2007-03-22 10:00:46 -06:00
|
|
|
if ((dn = of_find_node_by_path(path))) {
|
|
|
|
dev = ibmebus_register_device_node(dn);
|
|
|
|
of_node_put(dn);
|
|
|
|
rc = IS_ERR(dev) ? PTR_ERR(dev) : count;
|
|
|
|
} else {
|
|
|
|
printk(KERN_WARNING "%s: no such device node: %s\n",
|
|
|
|
__FUNCTION__, path);
|
|
|
|
rc = -ENODEV;
|
2007-03-09 11:00:32 -07:00
|
|
|
}
|
|
|
|
|
2007-03-22 10:00:46 -06:00
|
|
|
out:
|
|
|
|
kfree(path);
|
|
|
|
return rc;
|
2007-03-09 11:00:32 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t ibmebus_store_remove(struct bus_type *bus,
|
|
|
|
const char *buf, size_t count)
|
|
|
|
{
|
|
|
|
struct device *dev;
|
2007-03-22 10:00:46 -06:00
|
|
|
char *path;
|
2007-03-09 11:00:32 -07:00
|
|
|
|
2007-03-22 10:00:46 -06:00
|
|
|
path = ibmebus_chomp(buf, count);
|
|
|
|
if (!path)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
if ((dev = bus_find_device(&ibmebus_bus_type, NULL, path,
|
|
|
|
ibmebus_match_path))) {
|
2007-03-09 11:00:32 -07:00
|
|
|
ibmebus_unregister_device(dev);
|
2007-03-22 10:00:46 -06:00
|
|
|
|
|
|
|
kfree(path);
|
|
|
|
return count;
|
2007-03-09 11:00:32 -07:00
|
|
|
} else {
|
2007-03-22 10:00:46 -06:00
|
|
|
printk(KERN_WARNING "%s: %s not on the bus\n",
|
|
|
|
__FUNCTION__, path);
|
|
|
|
|
|
|
|
kfree(path);
|
2007-03-09 11:00:32 -07:00
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct bus_attribute ibmebus_bus_attrs[] = {
|
|
|
|
__ATTR(probe, S_IWUSR, NULL, ibmebus_store_probe),
|
|
|
|
__ATTR(remove, S_IWUSR, NULL, ibmebus_store_remove),
|
|
|
|
__ATTR_NULL
|
|
|
|
};
|
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
struct bus_type ibmebus_bus_type = {
|
2007-03-09 11:00:32 -07:00
|
|
|
.name = "ibmebus",
|
|
|
|
.match = ibmebus_bus_match,
|
|
|
|
.dev_attrs = ibmebus_dev_attrs,
|
|
|
|
.bus_attrs = ibmebus_bus_attrs
|
2005-11-16 00:56:43 -07:00
|
|
|
};
|
|
|
|
EXPORT_SYMBOL(ibmebus_bus_type);
|
|
|
|
|
|
|
|
static int __init ibmebus_bus_init(void)
|
|
|
|
{
|
|
|
|
int err;
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
printk(KERN_INFO "IBM eBus Device Driver\n");
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
err = bus_register(&ibmebus_bus_type);
|
|
|
|
if (err) {
|
|
|
|
printk(KERN_ERR ":%s: failed to register IBM eBus.\n",
|
|
|
|
__FUNCTION__);
|
|
|
|
return err;
|
|
|
|
}
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2007-03-09 11:00:32 -07:00
|
|
|
err = device_register(&ibmebus_bus_device);
|
2005-11-16 00:56:43 -07:00
|
|
|
if (err) {
|
2007-03-09 10:56:46 -07:00
|
|
|
printk(KERN_WARNING "%s: device_register returned %i\n",
|
2005-11-16 00:56:43 -07:00
|
|
|
__FUNCTION__, err);
|
|
|
|
bus_unregister(&ibmebus_bus_type);
|
|
|
|
|
|
|
|
return err;
|
|
|
|
}
|
2007-03-09 10:56:46 -07:00
|
|
|
|
2005-11-16 00:56:43 -07:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
__initcall(ibmebus_bus_init);
|