1 #include <linux/virtio.h>
2 #include <linux/spinlock.h>
3 #include <linux/virtio_config.h>
5 static ssize_t
device_show(struct device
*_d
,
6 struct device_attribute
*attr
, char *buf
)
8 struct virtio_device
*dev
= container_of(_d
,struct virtio_device
,dev
);
9 return sprintf(buf
, "%hu", dev
->id
.device
);
11 static ssize_t
vendor_show(struct device
*_d
,
12 struct device_attribute
*attr
, char *buf
)
14 struct virtio_device
*dev
= container_of(_d
,struct virtio_device
,dev
);
15 return sprintf(buf
, "%hu", dev
->id
.vendor
);
17 static ssize_t
status_show(struct device
*_d
,
18 struct device_attribute
*attr
, char *buf
)
20 struct virtio_device
*dev
= container_of(_d
,struct virtio_device
,dev
);
21 return sprintf(buf
, "0x%08x", dev
->config
->get_status(dev
));
23 static ssize_t
modalias_show(struct device
*_d
,
24 struct device_attribute
*attr
, char *buf
)
26 struct virtio_device
*dev
= container_of(_d
,struct virtio_device
,dev
);
28 return sprintf(buf
, "virtio:d%08Xv%08X\n",
29 dev
->id
.device
, dev
->id
.vendor
);
31 static struct device_attribute virtio_dev_attrs
[] = {
39 static inline int virtio_id_match(const struct virtio_device
*dev
,
40 const struct virtio_device_id
*id
)
42 if (id
->device
!= dev
->id
.device
)
45 return id
->vendor
== VIRTIO_DEV_ANY_ID
|| id
->vendor
!= dev
->id
.vendor
;
48 /* This looks through all the IDs a driver claims to support. If any of them
49 * match, we return 1 and the kernel will call virtio_dev_probe(). */
50 static int virtio_dev_match(struct device
*_dv
, struct device_driver
*_dr
)
53 struct virtio_device
*dev
= container_of(_dv
,struct virtio_device
,dev
);
54 const struct virtio_device_id
*ids
;
56 ids
= container_of(_dr
, struct virtio_driver
, driver
)->id_table
;
57 for (i
= 0; ids
[i
].device
; i
++)
58 if (virtio_id_match(dev
, &ids
[i
]))
63 static int virtio_uevent(struct device
*_dv
, struct kobj_uevent_env
*env
)
65 struct virtio_device
*dev
= container_of(_dv
,struct virtio_device
,dev
);
67 return add_uevent_var(env
, "MODALIAS=virtio:d%08Xv%08X",
68 dev
->id
.device
, dev
->id
.vendor
);
71 static struct bus_type virtio_bus
= {
73 .match
= virtio_dev_match
,
74 .dev_attrs
= virtio_dev_attrs
,
75 .uevent
= virtio_uevent
,
78 static void add_status(struct virtio_device
*dev
, unsigned status
)
80 dev
->config
->set_status(dev
, dev
->config
->get_status(dev
) | status
);
83 static int virtio_dev_probe(struct device
*_d
)
86 struct virtio_device
*dev
= container_of(_d
,struct virtio_device
,dev
);
87 struct virtio_driver
*drv
= container_of(dev
->dev
.driver
,
88 struct virtio_driver
, driver
);
90 add_status(dev
, VIRTIO_CONFIG_S_DRIVER
);
91 err
= drv
->probe(dev
);
93 add_status(dev
, VIRTIO_CONFIG_S_FAILED
);
95 add_status(dev
, VIRTIO_CONFIG_S_DRIVER_OK
);
99 int register_virtio_driver(struct virtio_driver
*driver
)
101 driver
->driver
.bus
= &virtio_bus
;
102 driver
->driver
.probe
= virtio_dev_probe
;
103 return driver_register(&driver
->driver
);
105 EXPORT_SYMBOL_GPL(register_virtio_driver
);
107 void unregister_virtio_driver(struct virtio_driver
*driver
)
109 driver_unregister(&driver
->driver
);
111 EXPORT_SYMBOL_GPL(unregister_virtio_driver
);
113 int register_virtio_device(struct virtio_device
*dev
)
117 dev
->dev
.bus
= &virtio_bus
;
118 sprintf(dev
->dev
.bus_id
, "%u", dev
->index
);
120 /* Acknowledge that we've seen the device. */
121 add_status(dev
, VIRTIO_CONFIG_S_ACKNOWLEDGE
);
123 /* device_register() causes the bus infrastructure to look for a
124 * matching driver. */
125 err
= device_register(&dev
->dev
);
127 add_status(dev
, VIRTIO_CONFIG_S_FAILED
);
130 EXPORT_SYMBOL_GPL(register_virtio_device
);
132 void unregister_virtio_device(struct virtio_device
*dev
)
134 device_unregister(&dev
->dev
);
136 EXPORT_SYMBOL_GPL(unregister_virtio_device
);
138 int __virtio_config_val(struct virtio_device
*vdev
,
139 u8 type
, void *val
, size_t size
)
144 token
= vdev
->config
->find(vdev
, type
, &len
);
151 vdev
->config
->get(vdev
, token
, val
, size
);
154 EXPORT_SYMBOL_GPL(__virtio_config_val
);
156 int virtio_use_bit(struct virtio_device
*vdev
,
157 void *token
, unsigned int len
, unsigned int bitnum
)
159 unsigned long bits
[16];
161 /* This makes it convenient to pass-through find() results. */
165 /* bit not in range of this bitfield? */
166 if (bitnum
* 8 >= len
/ 2)
169 /* Giant feature bitfields are silly. */
170 BUG_ON(len
> sizeof(bits
));
171 vdev
->config
->get(vdev
, token
, bits
, len
);
173 if (!test_bit(bitnum
, bits
))
176 /* Set acknowledge bit, and write it back. */
177 set_bit(bitnum
+ len
* 8 / 2, bits
);
178 vdev
->config
->set(vdev
, token
, bits
, len
);
181 EXPORT_SYMBOL_GPL(virtio_use_bit
);
183 static int virtio_init(void)
185 if (bus_register(&virtio_bus
) != 0)
186 panic("virtio bus registration failed");
189 core_initcall(virtio_init
);