1 /* vio.c: Virtual I/O channel devices probing infrastructure.
3 * Copyright (c) 2003-2005 IBM Corp.
4 * Dave Engebretsen engebret@us.ibm.com
5 * Santiago Leon santil@us.ibm.com
6 * Hollis Blanchard <hollisb@us.ibm.com>
9 * Adapted to sparc64 by David S. Miller davem@davemloft.net
12 #include <linux/kernel.h>
13 #include <linux/irq.h>
14 #include <linux/init.h>
16 #include <asm/mdesc.h>
19 static inline int find_in_proplist(const char *list
, const char *match
,
25 if (!strcmp(list
, match
))
34 static const struct vio_device_id
*vio_match_device(
35 const struct vio_device_id
*matches
,
36 const struct vio_dev
*dev
)
38 const char *type
, *compat
;
43 len
= dev
->compat_len
;
45 while (matches
->type
[0] || matches
->compat
[0]) {
48 match
&= !strcmp(matches
->type
, type
);
50 if (matches
->compat
[0]) {
52 find_in_proplist(compat
, matches
->compat
, len
);
61 static int vio_bus_match(struct device
*dev
, struct device_driver
*drv
)
63 struct vio_dev
*vio_dev
= to_vio_dev(dev
);
64 struct vio_driver
*vio_drv
= to_vio_driver(drv
);
65 const struct vio_device_id
*matches
= vio_drv
->id_table
;
70 return vio_match_device(matches
, vio_dev
) != NULL
;
73 static int vio_device_probe(struct device
*dev
)
75 struct vio_dev
*vdev
= to_vio_dev(dev
);
76 struct vio_driver
*drv
= to_vio_driver(dev
->driver
);
77 const struct vio_device_id
*id
;
81 id
= vio_match_device(drv
->id_table
, vdev
);
83 error
= drv
->probe(vdev
, id
);
89 static int vio_device_remove(struct device
*dev
)
91 struct vio_dev
*vdev
= to_vio_dev(dev
);
92 struct vio_driver
*drv
= to_vio_driver(dev
->driver
);
95 return drv
->remove(vdev
);
100 static ssize_t
devspec_show(struct device
*dev
,
101 struct device_attribute
*attr
, char *buf
)
103 struct vio_dev
*vdev
= to_vio_dev(dev
);
104 const char *str
= "none";
106 if (!strcmp(vdev
->type
, "vnet-port"))
108 else if (!strcmp(vdev
->type
, "vdc-port"))
111 return sprintf(buf
, "%s\n", str
);
114 static ssize_t
type_show(struct device
*dev
,
115 struct device_attribute
*attr
, char *buf
)
117 struct vio_dev
*vdev
= to_vio_dev(dev
);
118 return sprintf(buf
, "%s\n", vdev
->type
);
121 static struct device_attribute vio_dev_attrs
[] = {
127 static struct bus_type vio_bus_type
= {
129 .dev_attrs
= vio_dev_attrs
,
130 .match
= vio_bus_match
,
131 .probe
= vio_device_probe
,
132 .remove
= vio_device_remove
,
135 int vio_register_driver(struct vio_driver
*viodrv
)
137 viodrv
->driver
.bus
= &vio_bus_type
;
139 return driver_register(&viodrv
->driver
);
141 EXPORT_SYMBOL(vio_register_driver
);
143 void vio_unregister_driver(struct vio_driver
*viodrv
)
145 driver_unregister(&viodrv
->driver
);
147 EXPORT_SYMBOL(vio_unregister_driver
);
149 static void __devinit
vio_dev_release(struct device
*dev
)
151 kfree(to_vio_dev(dev
));
155 show_pciobppath_attr(struct device
*dev
, struct device_attribute
*attr
,
158 struct vio_dev
*vdev
;
159 struct device_node
*dp
;
161 vdev
= to_vio_dev(dev
);
164 return snprintf (buf
, PAGE_SIZE
, "%s\n", dp
->full_name
);
167 static DEVICE_ATTR(obppath
, S_IRUSR
| S_IRGRP
| S_IROTH
,
168 show_pciobppath_attr
, NULL
);
170 struct device_node
*cdev_node
;
172 static struct vio_dev
*root_vdev
;
173 static u64 cdev_cfg_handle
;
175 static void vio_fill_channel_info(struct mdesc_handle
*hp
, u64 mp
,
176 struct vio_dev
*vdev
)
180 mdesc_for_each_arc(a
, hp
, mp
, MDESC_ARC_TYPE_FWD
) {
185 target
= mdesc_arc_target(hp
, a
);
187 irq
= mdesc_get_property(hp
, target
, "tx-ino", NULL
);
189 vdev
->tx_irq
= sun4v_build_virq(cdev_cfg_handle
, *irq
);
191 irq
= mdesc_get_property(hp
, target
, "rx-ino", NULL
);
193 vdev
->rx_irq
= sun4v_build_virq(cdev_cfg_handle
, *irq
);
195 chan_id
= mdesc_get_property(hp
, target
, "id", NULL
);
197 vdev
->channel_id
= *chan_id
;
201 static struct vio_dev
*vio_create_one(struct mdesc_handle
*hp
, u64 mp
,
202 struct device
*parent
)
204 const char *type
, *compat
, *bus_id_name
;
205 struct device_node
*dp
;
206 struct vio_dev
*vdev
;
208 const u64
*id
, *cfg_handle
;
211 type
= mdesc_get_property(hp
, mp
, "device-type", &tlen
);
213 type
= mdesc_get_property(hp
, mp
, "name", &tlen
);
215 type
= mdesc_node_name(hp
, mp
);
216 tlen
= strlen(type
) + 1;
219 if (tlen
> VIO_MAX_TYPE_LEN
) {
220 printk(KERN_ERR
"VIO: Type string [%s] is too long.\n",
225 id
= mdesc_get_property(hp
, mp
, "id", NULL
);
228 mdesc_for_each_arc(a
, hp
, mp
, MDESC_ARC_TYPE_BACK
) {
231 target
= mdesc_arc_target(hp
, a
);
232 cfg_handle
= mdesc_get_property(hp
, target
,
239 if (!strcmp(type
, "domain-services-port"))
242 if (strlen(bus_id_name
) >= KOBJ_NAME_LEN
- 4) {
243 printk(KERN_ERR
"VIO: bus_id_name [%s] is too long.\n",
248 compat
= mdesc_get_property(hp
, mp
, "device-type", &clen
);
251 } else if (clen
> VIO_MAX_COMPAT_LEN
) {
252 printk(KERN_ERR
"VIO: Compat len %d for [%s] is too long.\n",
257 vdev
= kzalloc(sizeof(*vdev
), GFP_KERNEL
);
259 printk(KERN_ERR
"VIO: Could not allocate vio_dev\n");
264 memcpy(vdev
->type
, type
, tlen
);
266 memcpy(vdev
->compat
, compat
, clen
);
268 memset(vdev
->compat
, 0, sizeof(vdev
->compat
));
269 vdev
->compat_len
= clen
;
271 vdev
->channel_id
= ~0UL;
275 vio_fill_channel_info(hp
, mp
, vdev
);
278 snprintf(vdev
->dev
.bus_id
, BUS_ID_SIZE
, "%s",
280 vdev
->dev_no
= ~(u64
)0;
281 } else if (!cfg_handle
) {
282 snprintf(vdev
->dev
.bus_id
, BUS_ID_SIZE
, "%s-%lu",
286 snprintf(vdev
->dev
.bus_id
, BUS_ID_SIZE
, "%s-%lu-%lu",
287 bus_id_name
, *cfg_handle
, *id
);
288 vdev
->dev_no
= *cfg_handle
;
291 vdev
->dev
.parent
= parent
;
292 vdev
->dev
.bus
= &vio_bus_type
;
293 vdev
->dev
.release
= vio_dev_release
;
295 if (parent
== NULL
) {
297 } else if (to_vio_dev(parent
) == root_vdev
) {
298 dp
= of_get_next_child(cdev_node
, NULL
);
300 if (!strcmp(dp
->type
, type
))
303 dp
= of_get_next_child(cdev_node
, dp
);
306 dp
= to_vio_dev(parent
)->dp
;
310 printk(KERN_ERR
"VIO: Adding device %s\n", vdev
->dev
.bus_id
);
312 err
= device_register(&vdev
->dev
);
314 printk(KERN_ERR
"VIO: Could not register device %s, err=%d\n",
315 vdev
->dev
.bus_id
, err
);
320 err
= sysfs_create_file(&vdev
->dev
.kobj
,
321 &dev_attr_obppath
.attr
);
326 static void vio_add(struct mdesc_handle
*hp
, u64 node
)
328 (void) vio_create_one(hp
, node
, &root_vdev
->dev
);
331 static int vio_md_node_match(struct device
*dev
, void *arg
)
333 struct vio_dev
*vdev
= to_vio_dev(dev
);
335 if (vdev
->mp
== (u64
) arg
)
341 static void vio_remove(struct mdesc_handle
*hp
, u64 node
)
345 dev
= device_find_child(&root_vdev
->dev
, (void *) node
,
348 printk(KERN_INFO
"VIO: Removing device %s\n", dev
->bus_id
);
350 device_unregister(dev
);
354 static struct mdesc_notifier_client vio_device_notifier
= {
356 .remove
= vio_remove
,
357 .node_name
= "virtual-device-port",
360 static struct mdesc_notifier_client vio_ds_notifier
= {
362 .remove
= vio_remove
,
363 .node_name
= "domain-services-port",
366 const char *channel_devices_node
= "channel-devices";
367 const char *channel_devices_compat
= "SUNW,sun4v-channel-devices";
368 const char *cfg_handle_prop
= "cfg-handle";
370 static int __init
vio_init(void)
372 struct mdesc_handle
*hp
;
374 const u64
*cfg_handle
;
378 err
= bus_register(&vio_bus_type
);
380 printk(KERN_ERR
"VIO: Could not register bus type err=%d\n",
389 root
= mdesc_node_by_name(hp
, MDESC_NODE_NULL
, channel_devices_node
);
390 if (root
== MDESC_NODE_NULL
) {
391 printk(KERN_INFO
"VIO: No channel-devices MDESC node.\n");
396 cdev_node
= of_find_node_by_name(NULL
, "channel-devices");
399 printk(KERN_INFO
"VIO: No channel-devices OBP node.\n");
403 compat
= mdesc_get_property(hp
, root
, "compatible", &len
);
405 printk(KERN_ERR
"VIO: Channel devices lacks compatible "
409 if (!find_in_proplist(compat
, channel_devices_compat
, len
)) {
410 printk(KERN_ERR
"VIO: Channel devices node lacks (%s) "
411 "compat entry.\n", channel_devices_compat
);
415 cfg_handle
= mdesc_get_property(hp
, root
, cfg_handle_prop
, NULL
);
417 printk(KERN_ERR
"VIO: Channel devices lacks %s property\n",
422 cdev_cfg_handle
= *cfg_handle
;
424 root_vdev
= vio_create_one(hp
, root
, NULL
);
427 printk(KERN_ERR
"VIO: Coult not create root device.\n");
431 mdesc_register_notifier(&vio_device_notifier
);
432 mdesc_register_notifier(&vio_ds_notifier
);
443 postcore_initcall(vio_init
);