Rusty Russell | a23ea92 | 2010-01-18 19:14:55 +0530 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2006, 2007, 2009 Rusty Russell, IBM Corporation |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 3 | * |
| 4 | * This program is free software; you can redistribute it and/or modify |
| 5 | * it under the terms of the GNU General Public License as published by |
| 6 | * the Free Software Foundation; either version 2 of the License, or |
| 7 | * (at your option) any later version. |
| 8 | * |
| 9 | * This program is distributed in the hope that it will be useful, |
| 10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 12 | * GNU General Public License for more details. |
| 13 | * |
| 14 | * You should have received a copy of the GNU General Public License |
| 15 | * along with this program; if not, write to the Free Software |
| 16 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
| 17 | */ |
| 18 | #include <linux/err.h> |
| 19 | #include <linux/init.h> |
Amit Shah | 38edf58 | 2010-01-18 19:15:05 +0530 | [diff] [blame^] | 20 | #include <linux/list.h> |
| 21 | #include <linux/spinlock.h> |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 22 | #include <linux/virtio.h> |
| 23 | #include <linux/virtio_console.h> |
| 24 | #include "hvc_console.h" |
| 25 | |
Amit Shah | 38edf58 | 2010-01-18 19:15:05 +0530 | [diff] [blame^] | 26 | /* |
| 27 | * This is a global struct for storing common data for all the devices |
| 28 | * this driver handles. |
| 29 | * |
| 30 | * Mainly, it has a linked list for all the consoles in one place so |
| 31 | * that callbacks from hvc for get_chars(), put_chars() work properly |
| 32 | * across multiple devices and multiple ports per device. |
| 33 | */ |
| 34 | struct ports_driver_data { |
| 35 | /* All the console devices handled by this driver */ |
| 36 | struct list_head consoles; |
| 37 | }; |
| 38 | static struct ports_driver_data pdrvdata; |
| 39 | |
| 40 | DEFINE_SPINLOCK(pdrvdata_lock); |
| 41 | |
Amit Shah | fdb9a05 | 2010-01-18 19:15:01 +0530 | [diff] [blame] | 42 | struct port_buffer { |
| 43 | char *buf; |
| 44 | |
| 45 | /* size of the buffer in *buf above */ |
| 46 | size_t size; |
| 47 | |
| 48 | /* used length of the buffer */ |
| 49 | size_t len; |
| 50 | /* offset in the buf from which to consume data */ |
| 51 | size_t offset; |
| 52 | }; |
| 53 | |
Rusty Russell | 21206ed | 2010-01-18 19:15:00 +0530 | [diff] [blame] | 54 | struct port { |
| 55 | struct virtqueue *in_vq, *out_vq; |
| 56 | struct virtio_device *vdev; |
Amit Shah | fdb9a05 | 2010-01-18 19:15:01 +0530 | [diff] [blame] | 57 | |
| 58 | /* The current buffer from which data has to be fed to readers */ |
| 59 | struct port_buffer *inbuf; |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 60 | |
Amit Shah | 38edf58 | 2010-01-18 19:15:05 +0530 | [diff] [blame^] | 61 | /* For console ports, hvc != NULL and these are valid. */ |
Rusty Russell | 21206ed | 2010-01-18 19:15:00 +0530 | [diff] [blame] | 62 | /* The hvc device */ |
| 63 | struct hvc_struct *hvc; |
Amit Shah | 38edf58 | 2010-01-18 19:15:05 +0530 | [diff] [blame^] | 64 | |
| 65 | /* We'll place all consoles in a list in the pdrvdata struct */ |
| 66 | struct list_head list; |
| 67 | |
| 68 | /* Our vterm number. */ |
| 69 | u32 vtermno; |
Rusty Russell | 21206ed | 2010-01-18 19:15:00 +0530 | [diff] [blame] | 70 | }; |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 71 | |
Rusty Russell | 21206ed | 2010-01-18 19:15:00 +0530 | [diff] [blame] | 72 | /* We have one port ready to go immediately, for a console. */ |
| 73 | static struct port console; |
Christian Borntraeger | 91fcad1 | 2008-06-20 15:24:15 +0200 | [diff] [blame] | 74 | |
Rusty Russell | 971f339 | 2010-01-18 19:14:56 +0530 | [diff] [blame] | 75 | /* This is the very early arch-specified put chars function. */ |
| 76 | static int (*early_put_chars)(u32, const char *, int); |
| 77 | |
Amit Shah | 38edf58 | 2010-01-18 19:15:05 +0530 | [diff] [blame^] | 78 | static struct port *find_port_by_vtermno(u32 vtermno) |
| 79 | { |
| 80 | struct port *port; |
| 81 | unsigned long flags; |
| 82 | |
| 83 | spin_lock_irqsave(&pdrvdata_lock, flags); |
| 84 | list_for_each_entry(port, &pdrvdata.consoles, list) { |
| 85 | if (port->vtermno == vtermno) |
| 86 | goto out; |
| 87 | } |
| 88 | port = NULL; |
| 89 | out: |
| 90 | spin_unlock_irqrestore(&pdrvdata_lock, flags); |
| 91 | return port; |
| 92 | } |
| 93 | |
Amit Shah | fdb9a05 | 2010-01-18 19:15:01 +0530 | [diff] [blame] | 94 | static void free_buf(struct port_buffer *buf) |
| 95 | { |
| 96 | kfree(buf->buf); |
| 97 | kfree(buf); |
| 98 | } |
| 99 | |
| 100 | static struct port_buffer *alloc_buf(size_t buf_size) |
| 101 | { |
| 102 | struct port_buffer *buf; |
| 103 | |
| 104 | buf = kmalloc(sizeof(*buf), GFP_KERNEL); |
| 105 | if (!buf) |
| 106 | goto fail; |
| 107 | buf->buf = kzalloc(buf_size, GFP_KERNEL); |
| 108 | if (!buf->buf) |
| 109 | goto free_buf; |
| 110 | buf->len = 0; |
| 111 | buf->offset = 0; |
| 112 | buf->size = buf_size; |
| 113 | return buf; |
| 114 | |
| 115 | free_buf: |
| 116 | kfree(buf); |
| 117 | fail: |
| 118 | return NULL; |
| 119 | } |
| 120 | |
Amit Shah | a3cde44 | 2010-01-18 19:15:03 +0530 | [diff] [blame] | 121 | /* Callers should take appropriate locks */ |
| 122 | static void *get_inbuf(struct port *port) |
| 123 | { |
| 124 | struct port_buffer *buf; |
| 125 | struct virtqueue *vq; |
| 126 | unsigned int len; |
| 127 | |
| 128 | vq = port->in_vq; |
| 129 | buf = vq->vq_ops->get_buf(vq, &len); |
| 130 | if (buf) { |
| 131 | buf->len = len; |
| 132 | buf->offset = 0; |
| 133 | } |
| 134 | return buf; |
| 135 | } |
| 136 | |
Rusty Russell | a23ea92 | 2010-01-18 19:14:55 +0530 | [diff] [blame] | 137 | /* |
Amit Shah | e27b519 | 2010-01-18 19:15:02 +0530 | [diff] [blame] | 138 | * Create a scatter-gather list representing our input buffer and put |
| 139 | * it in the queue. |
| 140 | * |
| 141 | * Callers should take appropriate locks. |
| 142 | */ |
| 143 | static void add_inbuf(struct virtqueue *vq, struct port_buffer *buf) |
| 144 | { |
| 145 | struct scatterlist sg[1]; |
| 146 | sg_init_one(sg, buf->buf, buf->size); |
| 147 | |
| 148 | if (vq->vq_ops->add_buf(vq, sg, 0, 1, buf) < 0) |
| 149 | BUG(); |
| 150 | vq->vq_ops->kick(vq); |
| 151 | } |
| 152 | |
| 153 | /* |
Rusty Russell | a23ea92 | 2010-01-18 19:14:55 +0530 | [diff] [blame] | 154 | * The put_chars() callback is pretty straightforward. |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 155 | * |
Rusty Russell | a23ea92 | 2010-01-18 19:14:55 +0530 | [diff] [blame] | 156 | * We turn the characters into a scatter-gather list, add it to the |
| 157 | * output queue and then kick the Host. Then we sit here waiting for |
| 158 | * it to finish: inefficient in theory, but in practice |
| 159 | * implementations will do it immediately (lguest's Launcher does). |
| 160 | */ |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 161 | static int put_chars(u32 vtermno, const char *buf, int count) |
| 162 | { |
| 163 | struct scatterlist sg[1]; |
Rusty Russell | 21206ed | 2010-01-18 19:15:00 +0530 | [diff] [blame] | 164 | struct port *port; |
Amit Shah | 38edf58 | 2010-01-18 19:15:05 +0530 | [diff] [blame^] | 165 | unsigned int len; |
| 166 | |
| 167 | port = find_port_by_vtermno(vtermno); |
| 168 | if (!port) |
| 169 | return 0; |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 170 | |
Rusty Russell | 971f339 | 2010-01-18 19:14:56 +0530 | [diff] [blame] | 171 | if (unlikely(early_put_chars)) |
| 172 | return early_put_chars(vtermno, buf, count); |
| 173 | |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 174 | /* This is a convenient routine to initialize a single-elem sg list */ |
| 175 | sg_init_one(sg, buf, count); |
| 176 | |
Rusty Russell | 21206ed | 2010-01-18 19:15:00 +0530 | [diff] [blame] | 177 | /* This shouldn't fail: if it does, we lose chars. */ |
| 178 | if (port->out_vq->vq_ops->add_buf(port->out_vq, sg, 1, 0, port) >= 0) { |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 179 | /* Tell Host to go! */ |
Rusty Russell | 21206ed | 2010-01-18 19:15:00 +0530 | [diff] [blame] | 180 | port->out_vq->vq_ops->kick(port->out_vq); |
| 181 | while (!port->out_vq->vq_ops->get_buf(port->out_vq, &len)) |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 182 | cpu_relax(); |
| 183 | } |
| 184 | |
| 185 | /* We're expected to return the amount of data we wrote: all of it. */ |
| 186 | return count; |
| 187 | } |
| 188 | |
Rusty Russell | a23ea92 | 2010-01-18 19:14:55 +0530 | [diff] [blame] | 189 | /* |
Rusty Russell | a23ea92 | 2010-01-18 19:14:55 +0530 | [diff] [blame] | 190 | * get_chars() is the callback from the hvc_console infrastructure |
| 191 | * when an interrupt is received. |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 192 | * |
Rusty Russell | a23ea92 | 2010-01-18 19:14:55 +0530 | [diff] [blame] | 193 | * Most of the code deals with the fact that the hvc_console() |
| 194 | * infrastructure only asks us for 16 bytes at a time. We keep |
| 195 | * in_offset and in_used fields for partially-filled buffers. |
| 196 | */ |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 197 | static int get_chars(u32 vtermno, char *buf, int count) |
| 198 | { |
Rusty Russell | 21206ed | 2010-01-18 19:15:00 +0530 | [diff] [blame] | 199 | struct port *port; |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 200 | |
Amit Shah | 38edf58 | 2010-01-18 19:15:05 +0530 | [diff] [blame^] | 201 | |
| 202 | port = find_port_by_vtermno(vtermno); |
| 203 | if (!port) |
| 204 | return 0; |
Rusty Russell | 21206ed | 2010-01-18 19:15:00 +0530 | [diff] [blame] | 205 | |
| 206 | /* If we don't have an input queue yet, we can't get input. */ |
| 207 | BUG_ON(!port->in_vq); |
| 208 | |
| 209 | /* No more in buffer? See if they've (re)used it. */ |
Amit Shah | fdb9a05 | 2010-01-18 19:15:01 +0530 | [diff] [blame] | 210 | if (port->inbuf->offset == port->inbuf->len) { |
Amit Shah | a3cde44 | 2010-01-18 19:15:03 +0530 | [diff] [blame] | 211 | if (!get_inbuf(port)) |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 212 | return 0; |
| 213 | } |
| 214 | |
| 215 | /* You want more than we have to give? Well, try wanting less! */ |
Amit Shah | fdb9a05 | 2010-01-18 19:15:01 +0530 | [diff] [blame] | 216 | if (port->inbuf->offset + count > port->inbuf->len) |
| 217 | count = port->inbuf->len - port->inbuf->offset; |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 218 | |
| 219 | /* Copy across to their buffer and increment offset. */ |
Amit Shah | fdb9a05 | 2010-01-18 19:15:01 +0530 | [diff] [blame] | 220 | memcpy(buf, port->inbuf->buf + port->inbuf->offset, count); |
| 221 | port->inbuf->offset += count; |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 222 | |
| 223 | /* Finished? Re-register buffer so Host will use it again. */ |
Amit Shah | fdb9a05 | 2010-01-18 19:15:01 +0530 | [diff] [blame] | 224 | if (port->inbuf->offset == port->inbuf->len) |
Amit Shah | e27b519 | 2010-01-18 19:15:02 +0530 | [diff] [blame] | 225 | add_inbuf(port->in_vq, port->inbuf); |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 226 | |
| 227 | return count; |
| 228 | } |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 229 | |
Rusty Russell | a23ea92 | 2010-01-18 19:14:55 +0530 | [diff] [blame] | 230 | /* |
Christian Borntraeger | c298345 | 2008-11-25 13:36:26 +0100 | [diff] [blame] | 231 | * virtio console configuration. This supports: |
| 232 | * - console resize |
| 233 | */ |
| 234 | static void virtcons_apply_config(struct virtio_device *dev) |
| 235 | { |
Rusty Russell | 73954488 | 2010-01-18 19:15:04 +0530 | [diff] [blame] | 236 | struct port *port = dev->priv; |
Christian Borntraeger | c298345 | 2008-11-25 13:36:26 +0100 | [diff] [blame] | 237 | struct winsize ws; |
| 238 | |
| 239 | if (virtio_has_feature(dev, VIRTIO_CONSOLE_F_SIZE)) { |
| 240 | dev->config->get(dev, |
| 241 | offsetof(struct virtio_console_config, cols), |
| 242 | &ws.ws_col, sizeof(u16)); |
| 243 | dev->config->get(dev, |
| 244 | offsetof(struct virtio_console_config, rows), |
| 245 | &ws.ws_row, sizeof(u16)); |
Rusty Russell | 73954488 | 2010-01-18 19:15:04 +0530 | [diff] [blame] | 246 | hvc_resize(port->hvc, ws); |
Christian Borntraeger | c298345 | 2008-11-25 13:36:26 +0100 | [diff] [blame] | 247 | } |
| 248 | } |
| 249 | |
Amit Shah | 38edf58 | 2010-01-18 19:15:05 +0530 | [diff] [blame^] | 250 | /* We set the configuration at this point, since we now have a tty */ |
Christian Borntraeger | 91fcad1 | 2008-06-20 15:24:15 +0200 | [diff] [blame] | 251 | static int notifier_add_vio(struct hvc_struct *hp, int data) |
| 252 | { |
Amit Shah | 38edf58 | 2010-01-18 19:15:05 +0530 | [diff] [blame^] | 253 | struct port *port; |
| 254 | |
| 255 | port = find_port_by_vtermno(hp->vtermno); |
| 256 | if (!port) |
| 257 | return -EINVAL; |
| 258 | |
Christian Borntraeger | 91fcad1 | 2008-06-20 15:24:15 +0200 | [diff] [blame] | 259 | hp->irq_requested = 1; |
Amit Shah | 38edf58 | 2010-01-18 19:15:05 +0530 | [diff] [blame^] | 260 | virtcons_apply_config(port->vdev); |
Christian Borntraeger | c298345 | 2008-11-25 13:36:26 +0100 | [diff] [blame] | 261 | |
Christian Borntraeger | 91fcad1 | 2008-06-20 15:24:15 +0200 | [diff] [blame] | 262 | return 0; |
| 263 | } |
| 264 | |
| 265 | static void notifier_del_vio(struct hvc_struct *hp, int data) |
| 266 | { |
| 267 | hp->irq_requested = 0; |
| 268 | } |
| 269 | |
| 270 | static void hvc_handle_input(struct virtqueue *vq) |
| 271 | { |
Rusty Russell | 73954488 | 2010-01-18 19:15:04 +0530 | [diff] [blame] | 272 | struct port *port = vq->vdev->priv; |
| 273 | |
| 274 | if (hvc_poll(port->hvc)) |
Christian Borntraeger | 91fcad1 | 2008-06-20 15:24:15 +0200 | [diff] [blame] | 275 | hvc_kick(); |
| 276 | } |
| 277 | |
Rusty Russell | 971f339 | 2010-01-18 19:14:56 +0530 | [diff] [blame] | 278 | /* The operations for the console. */ |
Rusty Russell | 1dff399 | 2009-11-28 12:20:26 +0530 | [diff] [blame] | 279 | static const struct hv_ops hv_ops = { |
Rusty Russell | 971f339 | 2010-01-18 19:14:56 +0530 | [diff] [blame] | 280 | .get_chars = get_chars, |
| 281 | .put_chars = put_chars, |
| 282 | .notifier_add = notifier_add_vio, |
| 283 | .notifier_del = notifier_del_vio, |
| 284 | .notifier_hangup = notifier_del_vio, |
| 285 | }; |
| 286 | |
| 287 | /* |
| 288 | * Console drivers are initialized very early so boot messages can go |
| 289 | * out, so we do things slightly differently from the generic virtio |
| 290 | * initialization of the net and block drivers. |
| 291 | * |
| 292 | * At this stage, the console is output-only. It's too early to set |
| 293 | * up a virtqueue, so we let the drivers do some boutique early-output |
| 294 | * thing. |
| 295 | */ |
| 296 | int __init virtio_cons_early_init(int (*put_chars)(u32, const char *, int)) |
| 297 | { |
| 298 | early_put_chars = put_chars; |
| 299 | return hvc_instantiate(0, 0, &hv_ops); |
| 300 | } |
| 301 | |
Rusty Russell | a23ea92 | 2010-01-18 19:14:55 +0530 | [diff] [blame] | 302 | /* |
| 303 | * Once we're further in boot, we get probed like any other virtio |
| 304 | * device. At this stage we set up the output virtqueue. |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 305 | * |
Rusty Russell | a23ea92 | 2010-01-18 19:14:55 +0530 | [diff] [blame] | 306 | * To set up and manage our virtual console, we call hvc_alloc(). |
| 307 | * Since we never remove the console device we never need this pointer |
| 308 | * again. |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 309 | * |
Rusty Russell | a23ea92 | 2010-01-18 19:14:55 +0530 | [diff] [blame] | 310 | * Finally we put our input buffer in the input queue, ready to |
| 311 | * receive. |
| 312 | */ |
Rusty Russell | 21206ed | 2010-01-18 19:15:00 +0530 | [diff] [blame] | 313 | static int __devinit virtcons_probe(struct virtio_device *vdev) |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 314 | { |
Michael S. Tsirkin | d2a7ddd | 2009-06-12 22:16:36 -0600 | [diff] [blame] | 315 | vq_callback_t *callbacks[] = { hvc_handle_input, NULL}; |
| 316 | const char *names[] = { "input", "output" }; |
| 317 | struct virtqueue *vqs[2]; |
Rusty Russell | 21206ed | 2010-01-18 19:15:00 +0530 | [diff] [blame] | 318 | struct port *port; |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 319 | int err; |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 320 | |
Rusty Russell | 21206ed | 2010-01-18 19:15:00 +0530 | [diff] [blame] | 321 | port = &console; |
| 322 | if (port->vdev) { |
| 323 | dev_warn(&port->vdev->dev, |
Amit Shah | f550804 | 2010-01-18 19:14:59 +0530 | [diff] [blame] | 324 | "Multiple virtio-console devices not supported yet\n"); |
| 325 | return -EEXIST; |
| 326 | } |
Rusty Russell | 73954488 | 2010-01-18 19:15:04 +0530 | [diff] [blame] | 327 | |
| 328 | /* Attach this port to this virtio_device, and vice-versa. */ |
Rusty Russell | 21206ed | 2010-01-18 19:15:00 +0530 | [diff] [blame] | 329 | port->vdev = vdev; |
Rusty Russell | 73954488 | 2010-01-18 19:15:04 +0530 | [diff] [blame] | 330 | vdev->priv = port; |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 331 | |
| 332 | /* This is the scratch page we use to receive console input */ |
Amit Shah | fdb9a05 | 2010-01-18 19:15:01 +0530 | [diff] [blame] | 333 | port->inbuf = alloc_buf(PAGE_SIZE); |
Rusty Russell | 21206ed | 2010-01-18 19:15:00 +0530 | [diff] [blame] | 334 | if (!port->inbuf) { |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 335 | err = -ENOMEM; |
| 336 | goto fail; |
| 337 | } |
| 338 | |
Michael S. Tsirkin | d2a7ddd | 2009-06-12 22:16:36 -0600 | [diff] [blame] | 339 | /* Find the queues. */ |
Michael S. Tsirkin | d2a7ddd | 2009-06-12 22:16:36 -0600 | [diff] [blame] | 340 | err = vdev->config->find_vqs(vdev, 2, vqs, callbacks, names); |
| 341 | if (err) |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 342 | goto free; |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 343 | |
Rusty Russell | 21206ed | 2010-01-18 19:15:00 +0530 | [diff] [blame] | 344 | port->in_vq = vqs[0]; |
| 345 | port->out_vq = vqs[1]; |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 346 | |
Rusty Russell | a23ea92 | 2010-01-18 19:14:55 +0530 | [diff] [blame] | 347 | /* |
| 348 | * The first argument of hvc_alloc() is the virtual console |
| 349 | * number, so we use zero. The second argument is the |
| 350 | * parameter for the notification mechanism (like irq |
| 351 | * number). We currently leave this as zero, virtqueues have |
| 352 | * implicit notifications. |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 353 | * |
Rusty Russell | a23ea92 | 2010-01-18 19:14:55 +0530 | [diff] [blame] | 354 | * The third argument is a "struct hv_ops" containing the |
| 355 | * put_chars(), get_chars(), notifier_add() and notifier_del() |
| 356 | * pointers. The final argument is the output buffer size: we |
| 357 | * can do any size, so we put PAGE_SIZE here. |
| 358 | */ |
Rusty Russell | 21206ed | 2010-01-18 19:15:00 +0530 | [diff] [blame] | 359 | port->hvc = hvc_alloc(0, 0, &hv_ops, PAGE_SIZE); |
| 360 | if (IS_ERR(port->hvc)) { |
| 361 | err = PTR_ERR(port->hvc); |
Michael S. Tsirkin | d2a7ddd | 2009-06-12 22:16:36 -0600 | [diff] [blame] | 362 | goto free_vqs; |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 363 | } |
| 364 | |
Amit Shah | 38edf58 | 2010-01-18 19:15:05 +0530 | [diff] [blame^] | 365 | /* Add to vtermno list. */ |
| 366 | spin_lock_irq(&pdrvdata_lock); |
| 367 | list_add(&port->list, &pdrvdata.consoles); |
| 368 | spin_unlock_irq(&pdrvdata_lock); |
| 369 | |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 370 | /* Register the input buffer the first time. */ |
Amit Shah | e27b519 | 2010-01-18 19:15:02 +0530 | [diff] [blame] | 371 | add_inbuf(port->in_vq, port->inbuf); |
Rusty Russell | 971f339 | 2010-01-18 19:14:56 +0530 | [diff] [blame] | 372 | |
| 373 | /* Start using the new console output. */ |
| 374 | early_put_chars = NULL; |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 375 | return 0; |
| 376 | |
Michael S. Tsirkin | d2a7ddd | 2009-06-12 22:16:36 -0600 | [diff] [blame] | 377 | free_vqs: |
| 378 | vdev->config->del_vqs(vdev); |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 379 | free: |
Amit Shah | fdb9a05 | 2010-01-18 19:15:01 +0530 | [diff] [blame] | 380 | free_buf(port->inbuf); |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 381 | fail: |
| 382 | return err; |
| 383 | } |
| 384 | |
| 385 | static struct virtio_device_id id_table[] = { |
| 386 | { VIRTIO_ID_CONSOLE, VIRTIO_DEV_ANY_ID }, |
| 387 | { 0 }, |
| 388 | }; |
| 389 | |
Christian Borntraeger | c298345 | 2008-11-25 13:36:26 +0100 | [diff] [blame] | 390 | static unsigned int features[] = { |
| 391 | VIRTIO_CONSOLE_F_SIZE, |
| 392 | }; |
| 393 | |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 394 | static struct virtio_driver virtio_console = { |
Christian Borntraeger | c298345 | 2008-11-25 13:36:26 +0100 | [diff] [blame] | 395 | .feature_table = features, |
| 396 | .feature_table_size = ARRAY_SIZE(features), |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 397 | .driver.name = KBUILD_MODNAME, |
| 398 | .driver.owner = THIS_MODULE, |
| 399 | .id_table = id_table, |
| 400 | .probe = virtcons_probe, |
Christian Borntraeger | c298345 | 2008-11-25 13:36:26 +0100 | [diff] [blame] | 401 | .config_changed = virtcons_apply_config, |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 402 | }; |
| 403 | |
| 404 | static int __init init(void) |
| 405 | { |
Amit Shah | 38edf58 | 2010-01-18 19:15:05 +0530 | [diff] [blame^] | 406 | INIT_LIST_HEAD(&pdrvdata.consoles); |
| 407 | |
Rusty Russell | 3161043 | 2007-10-22 11:03:39 +1000 | [diff] [blame] | 408 | return register_virtio_driver(&virtio_console); |
| 409 | } |
| 410 | module_init(init); |
| 411 | |
| 412 | MODULE_DEVICE_TABLE(virtio, id_table); |
| 413 | MODULE_DESCRIPTION("Virtio console driver"); |
| 414 | MODULE_LICENSE("GPL"); |