blob: 7e1ef0ebbb800bfcf00d7d07aaff02f7a5af7b4a [file] [log] [blame]
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -07001/*
2 * Intel MIC Platform Software Stack (MPSS)
3 *
4 * Copyright(c) 2013 Intel Corporation.
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License, version 2, as
8 * published by the Free Software Foundation.
9 *
10 * This program is distributed in the hope that it will be useful, but
11 * WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
13 * General Public License for more details.
14 *
15 * The full GNU General Public License is included in this distribution in
16 * the file called "COPYING".
17 *
18 * Intel MIC Host driver.
19 *
20 */
21#include <linux/pci.h>
22#include <linux/sched.h>
23#include <linux/uaccess.h>
24
25#include <linux/mic_common.h>
Sudeep Dutt4aa79962013-09-27 09:49:42 -070026#include "../common/mic_dev.h"
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -070027#include "mic_device.h"
28#include "mic_smpt.h"
29#include "mic_virtio.h"
30
31/*
32 * Initiates the copies across the PCIe bus from card memory to
33 * a user space buffer.
34 */
35static int mic_virtio_copy_to_user(struct mic_vdev *mvdev,
36 void __user *ubuf, size_t len, u64 addr)
37{
38 int err;
39 void __iomem *dbuf = mvdev->mdev->aper.va + addr;
40 /*
41 * We are copying from IO below an should ideally use something
42 * like copy_to_user_fromio(..) if it existed.
43 */
Ashutosh Dixit1a928622013-11-27 08:58:43 -080044 if (copy_to_user(ubuf, (void __force *)dbuf, len)) {
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -070045 err = -EFAULT;
46 dev_err(mic_dev(mvdev), "%s %d err %d\n",
47 __func__, __LINE__, err);
48 goto err;
49 }
50 mvdev->in_bytes += len;
51 err = 0;
52err:
53 return err;
54}
55
56/*
57 * Initiates copies across the PCIe bus from a user space
58 * buffer to card memory.
59 */
60static int mic_virtio_copy_from_user(struct mic_vdev *mvdev,
61 void __user *ubuf, size_t len, u64 addr)
62{
63 int err;
64 void __iomem *dbuf = mvdev->mdev->aper.va + addr;
65 /*
66 * We are copying to IO below and should ideally use something
67 * like copy_from_user_toio(..) if it existed.
68 */
Ashutosh Dixit1a928622013-11-27 08:58:43 -080069 if (copy_from_user((void __force *)dbuf, ubuf, len)) {
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -070070 err = -EFAULT;
71 dev_err(mic_dev(mvdev), "%s %d err %d\n",
72 __func__, __LINE__, err);
73 goto err;
74 }
75 mvdev->out_bytes += len;
76 err = 0;
77err:
78 return err;
79}
80
81#define MIC_VRINGH_READ true
82
83/* The function to call to notify the card about added buffers */
84static void mic_notify(struct vringh *vrh)
85{
86 struct mic_vringh *mvrh = container_of(vrh, struct mic_vringh, vrh);
87 struct mic_vdev *mvdev = mvrh->mvdev;
88 s8 db = mvdev->dc->h2c_vdev_db;
89
90 if (db != -1)
91 mvdev->mdev->ops->send_intr(mvdev->mdev, db);
92}
93
94/* Determine the total number of bytes consumed in a VRINGH KIOV */
95static inline u32 mic_vringh_iov_consumed(struct vringh_kiov *iov)
96{
97 int i;
98 u32 total = iov->consumed;
99
100 for (i = 0; i < iov->i; i++)
101 total += iov->iov[i].iov_len;
102 return total;
103}
104
105/*
106 * Traverse the VRINGH KIOV and issue the APIs to trigger the copies.
107 * This API is heavily based on the vringh_iov_xfer(..) implementation
108 * in vringh.c. The reason we cannot reuse vringh_iov_pull_kern(..)
109 * and vringh_iov_push_kern(..) directly is because there is no
110 * way to override the VRINGH xfer(..) routines as of v3.10.
111 */
112static int mic_vringh_copy(struct mic_vdev *mvdev, struct vringh_kiov *iov,
113 void __user *ubuf, size_t len, bool read, size_t *out_len)
114{
115 int ret = 0;
116 size_t partlen, tot_len = 0;
117
118 while (len && iov->i < iov->used) {
119 partlen = min(iov->iov[iov->i].iov_len, len);
120 if (read)
121 ret = mic_virtio_copy_to_user(mvdev,
122 ubuf, partlen,
123 (u64)iov->iov[iov->i].iov_base);
124 else
125 ret = mic_virtio_copy_from_user(mvdev,
126 ubuf, partlen,
127 (u64)iov->iov[iov->i].iov_base);
128 if (ret) {
129 dev_err(mic_dev(mvdev), "%s %d err %d\n",
130 __func__, __LINE__, ret);
131 break;
132 }
133 len -= partlen;
134 ubuf += partlen;
135 tot_len += partlen;
136 iov->consumed += partlen;
137 iov->iov[iov->i].iov_len -= partlen;
138 iov->iov[iov->i].iov_base += partlen;
139 if (!iov->iov[iov->i].iov_len) {
140 /* Fix up old iov element then increment. */
141 iov->iov[iov->i].iov_len = iov->consumed;
142 iov->iov[iov->i].iov_base -= iov->consumed;
143
144 iov->consumed = 0;
145 iov->i++;
146 }
147 }
148 *out_len = tot_len;
149 return ret;
150}
151
152/*
153 * Use the standard VRINGH infrastructure in the kernel to fetch new
154 * descriptors, initiate the copies and update the used ring.
155 */
156static int _mic_virtio_copy(struct mic_vdev *mvdev,
157 struct mic_copy_desc *copy)
158{
Sudeep Dutt3b1cc9b2014-02-03 14:53:19 -0800159 int ret = 0;
160 u32 iovcnt = copy->iovcnt;
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700161 struct iovec iov;
162 struct iovec __user *u_iov = copy->iov;
163 void __user *ubuf = NULL;
164 struct mic_vringh *mvr = &mvdev->mvr[copy->vr_idx];
165 struct vringh_kiov *riov = &mvr->riov;
166 struct vringh_kiov *wiov = &mvr->wiov;
167 struct vringh *vrh = &mvr->vrh;
168 u16 *head = &mvr->head;
169 struct mic_vring *vr = &mvr->vring;
170 size_t len = 0, out_len;
171
172 copy->out_len = 0;
173 /* Fetch a new IOVEC if all previous elements have been processed */
174 if (riov->i == riov->used && wiov->i == wiov->used) {
175 ret = vringh_getdesc_kern(vrh, riov, wiov,
176 head, GFP_KERNEL);
177 /* Check if there are available descriptors */
178 if (ret <= 0)
179 return ret;
180 }
181 while (iovcnt) {
182 if (!len) {
183 /* Copy over a new iovec from user space. */
184 ret = copy_from_user(&iov, u_iov, sizeof(*u_iov));
185 if (ret) {
186 ret = -EINVAL;
187 dev_err(mic_dev(mvdev), "%s %d err %d\n",
188 __func__, __LINE__, ret);
189 break;
190 }
191 len = iov.iov_len;
192 ubuf = iov.iov_base;
193 }
194 /* Issue all the read descriptors first */
195 ret = mic_vringh_copy(mvdev, riov, ubuf, len,
196 MIC_VRINGH_READ, &out_len);
197 if (ret) {
198 dev_err(mic_dev(mvdev), "%s %d err %d\n",
Ashutosh Dixitced2c602013-09-27 09:49:53 -0700199 __func__, __LINE__, ret);
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700200 break;
201 }
202 len -= out_len;
203 ubuf += out_len;
204 copy->out_len += out_len;
205 /* Issue the write descriptors next */
206 ret = mic_vringh_copy(mvdev, wiov, ubuf, len,
207 !MIC_VRINGH_READ, &out_len);
208 if (ret) {
209 dev_err(mic_dev(mvdev), "%s %d err %d\n",
Ashutosh Dixitced2c602013-09-27 09:49:53 -0700210 __func__, __LINE__, ret);
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700211 break;
212 }
213 len -= out_len;
214 ubuf += out_len;
215 copy->out_len += out_len;
216 if (!len) {
217 /* One user space iovec is now completed */
218 iovcnt--;
219 u_iov++;
220 }
221 /* Exit loop if all elements in KIOVs have been processed. */
222 if (riov->i == riov->used && wiov->i == wiov->used)
223 break;
224 }
225 /*
226 * Update the used ring if a descriptor was available and some data was
227 * copied in/out and the user asked for a used ring update.
228 */
Ashutosh Dixitced2c602013-09-27 09:49:53 -0700229 if (*head != USHRT_MAX && copy->out_len && copy->update_used) {
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700230 u32 total = 0;
231
232 /* Determine the total data consumed */
233 total += mic_vringh_iov_consumed(riov);
234 total += mic_vringh_iov_consumed(wiov);
235 vringh_complete_kern(vrh, *head, total);
236 *head = USHRT_MAX;
237 if (vringh_need_notify_kern(vrh) > 0)
238 vringh_notify(vrh);
239 vringh_kiov_cleanup(riov);
240 vringh_kiov_cleanup(wiov);
241 /* Update avail idx for user space */
242 vr->info->avail_idx = vrh->last_avail_idx;
243 }
244 return ret;
245}
246
247static inline int mic_verify_copy_args(struct mic_vdev *mvdev,
248 struct mic_copy_desc *copy)
249{
250 if (copy->vr_idx >= mvdev->dd->num_vq) {
251 dev_err(mic_dev(mvdev), "%s %d err %d\n",
252 __func__, __LINE__, -EINVAL);
253 return -EINVAL;
254 }
255 return 0;
256}
257
258/* Copy a specified number of virtio descriptors in a chain */
259int mic_virtio_copy_desc(struct mic_vdev *mvdev,
260 struct mic_copy_desc *copy)
261{
262 int err;
263 struct mic_vringh *mvr = &mvdev->mvr[copy->vr_idx];
264
265 err = mic_verify_copy_args(mvdev, copy);
266 if (err)
267 return err;
268
269 mutex_lock(&mvr->vr_mutex);
270 if (!mic_vdevup(mvdev)) {
271 err = -ENODEV;
272 dev_err(mic_dev(mvdev), "%s %d err %d\n",
273 __func__, __LINE__, err);
274 goto err;
275 }
276 err = _mic_virtio_copy(mvdev, copy);
277 if (err) {
278 dev_err(mic_dev(mvdev), "%s %d err %d\n",
279 __func__, __LINE__, err);
280 }
281err:
282 mutex_unlock(&mvr->vr_mutex);
283 return err;
284}
285
286static void mic_virtio_init_post(struct mic_vdev *mvdev)
287{
288 struct mic_vqconfig *vqconfig = mic_vq_config(mvdev->dd);
289 int i;
290
291 for (i = 0; i < mvdev->dd->num_vq; i++) {
292 if (!le64_to_cpu(vqconfig[i].used_address)) {
293 dev_warn(mic_dev(mvdev), "used_address zero??\n");
294 continue;
295 }
296 mvdev->mvr[i].vrh.vring.used =
Ashutosh Dixit1a928622013-11-27 08:58:43 -0800297 (void __force *)mvdev->mdev->aper.va +
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700298 le64_to_cpu(vqconfig[i].used_address);
299 }
300
301 mvdev->dc->used_address_updated = 0;
302
303 dev_dbg(mic_dev(mvdev), "%s: device type %d LINKUP\n",
304 __func__, mvdev->virtio_id);
305}
306
307static inline void mic_virtio_device_reset(struct mic_vdev *mvdev)
308{
309 int i;
310
311 dev_dbg(mic_dev(mvdev), "%s: status %d device type %d RESET\n",
312 __func__, mvdev->dd->status, mvdev->virtio_id);
313
314 for (i = 0; i < mvdev->dd->num_vq; i++)
315 /*
316 * Avoid lockdep false positive. The + 1 is for the mic
317 * mutex which is held in the reset devices code path.
318 */
319 mutex_lock_nested(&mvdev->mvr[i].vr_mutex, i + 1);
320
321 /* 0 status means "reset" */
322 mvdev->dd->status = 0;
323 mvdev->dc->vdev_reset = 0;
324 mvdev->dc->host_ack = 1;
325
326 for (i = 0; i < mvdev->dd->num_vq; i++) {
327 struct vringh *vrh = &mvdev->mvr[i].vrh;
328 mvdev->mvr[i].vring.info->avail_idx = 0;
329 vrh->completed = 0;
330 vrh->last_avail_idx = 0;
331 vrh->last_used_idx = 0;
332 }
333
334 for (i = 0; i < mvdev->dd->num_vq; i++)
335 mutex_unlock(&mvdev->mvr[i].vr_mutex);
336}
337
338void mic_virtio_reset_devices(struct mic_device *mdev)
339{
340 struct list_head *pos, *tmp;
341 struct mic_vdev *mvdev;
342
343 dev_dbg(mdev->sdev->parent, "%s\n", __func__);
344
345 list_for_each_safe(pos, tmp, &mdev->vdev_list) {
346 mvdev = list_entry(pos, struct mic_vdev, list);
347 mic_virtio_device_reset(mvdev);
348 mvdev->poll_wake = 1;
349 wake_up(&mvdev->waitq);
350 }
351}
352
353void mic_bh_handler(struct work_struct *work)
354{
355 struct mic_vdev *mvdev = container_of(work, struct mic_vdev,
356 virtio_bh_work);
357
358 if (mvdev->dc->used_address_updated)
359 mic_virtio_init_post(mvdev);
360
361 if (mvdev->dc->vdev_reset)
362 mic_virtio_device_reset(mvdev);
363
364 mvdev->poll_wake = 1;
365 wake_up(&mvdev->waitq);
366}
367
368static irqreturn_t mic_virtio_intr_handler(int irq, void *data)
369{
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700370 struct mic_vdev *mvdev = data;
371 struct mic_device *mdev = mvdev->mdev;
372
Dasaratharaman Chandramoulidf5e4e82013-12-10 09:51:12 -0800373 mdev->ops->intr_workarounds(mdev);
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700374 schedule_work(&mvdev->virtio_bh_work);
375 return IRQ_HANDLED;
376}
377
378int mic_virtio_config_change(struct mic_vdev *mvdev,
379 void __user *argp)
380{
381 DECLARE_WAIT_QUEUE_HEAD_ONSTACK(wake);
Sudeep Dutt9420b342013-11-27 08:58:39 -0800382 int ret = 0, retry, i;
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700383 struct mic_bootparam *bootparam = mvdev->mdev->dp;
384 s8 db = bootparam->h2c_config_db;
385
386 mutex_lock(&mvdev->mdev->mic_mutex);
387 for (i = 0; i < mvdev->dd->num_vq; i++)
388 mutex_lock_nested(&mvdev->mvr[i].vr_mutex, i + 1);
389
390 if (db == -1 || mvdev->dd->type == -1) {
391 ret = -EIO;
392 goto exit;
393 }
394
395 if (copy_from_user(mic_vq_configspace(mvdev->dd),
Ashutosh Dixitced2c602013-09-27 09:49:53 -0700396 argp, mvdev->dd->config_len)) {
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700397 dev_err(mic_dev(mvdev), "%s %d err %d\n",
398 __func__, __LINE__, -EFAULT);
399 ret = -EFAULT;
400 goto exit;
401 }
402 mvdev->dc->config_change = MIC_VIRTIO_PARAM_CONFIG_CHANGED;
403 mvdev->mdev->ops->send_intr(mvdev->mdev, db);
404
Sudeep Dutt9420b342013-11-27 08:58:39 -0800405 for (retry = 100; retry--;) {
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700406 ret = wait_event_timeout(wake,
407 mvdev->dc->guest_ack, msecs_to_jiffies(100));
408 if (ret)
409 break;
410 }
411
412 dev_dbg(mic_dev(mvdev),
413 "%s %d retry: %d\n", __func__, __LINE__, retry);
414 mvdev->dc->config_change = 0;
415 mvdev->dc->guest_ack = 0;
416exit:
417 for (i = 0; i < mvdev->dd->num_vq; i++)
418 mutex_unlock(&mvdev->mvr[i].vr_mutex);
419 mutex_unlock(&mvdev->mdev->mic_mutex);
420 return ret;
421}
422
423static int mic_copy_dp_entry(struct mic_vdev *mvdev,
424 void __user *argp,
425 __u8 *type,
426 struct mic_device_desc **devpage)
427{
428 struct mic_device *mdev = mvdev->mdev;
429 struct mic_device_desc dd, *dd_config, *devp;
430 struct mic_vqconfig *vqconfig;
431 int ret = 0, i;
432 bool slot_found = false;
433
434 if (copy_from_user(&dd, argp, sizeof(dd))) {
435 dev_err(mic_dev(mvdev), "%s %d err %d\n",
436 __func__, __LINE__, -EFAULT);
437 return -EFAULT;
438 }
439
Ashutosh Dixitced2c602013-09-27 09:49:53 -0700440 if (mic_aligned_desc_size(&dd) > MIC_MAX_DESC_BLK_SIZE ||
441 dd.num_vq > MIC_MAX_VRINGS) {
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700442 dev_err(mic_dev(mvdev), "%s %d err %d\n",
443 __func__, __LINE__, -EINVAL);
444 return -EINVAL;
445 }
446
447 dd_config = kmalloc(mic_desc_size(&dd), GFP_KERNEL);
448 if (dd_config == NULL) {
449 dev_err(mic_dev(mvdev), "%s %d err %d\n",
450 __func__, __LINE__, -ENOMEM);
451 return -ENOMEM;
452 }
453 if (copy_from_user(dd_config, argp, mic_desc_size(&dd))) {
454 ret = -EFAULT;
455 dev_err(mic_dev(mvdev), "%s %d err %d\n",
456 __func__, __LINE__, ret);
457 goto exit;
458 }
459
460 vqconfig = mic_vq_config(dd_config);
461 for (i = 0; i < dd.num_vq; i++) {
462 if (le16_to_cpu(vqconfig[i].num) > MIC_MAX_VRING_ENTRIES) {
463 ret = -EINVAL;
464 dev_err(mic_dev(mvdev), "%s %d err %d\n",
465 __func__, __LINE__, ret);
466 goto exit;
467 }
468 }
469
470 /* Find the first free device page entry */
Ashutosh Dixit1e31aa92013-11-27 08:58:41 -0800471 for (i = sizeof(struct mic_bootparam);
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700472 i < MIC_DP_SIZE - mic_total_desc_size(dd_config);
473 i += mic_total_desc_size(devp)) {
474 devp = mdev->dp + i;
475 if (devp->type == 0 || devp->type == -1) {
476 slot_found = true;
477 break;
478 }
479 }
480 if (!slot_found) {
481 ret = -EINVAL;
482 dev_err(mic_dev(mvdev), "%s %d err %d\n",
483 __func__, __LINE__, ret);
484 goto exit;
485 }
486 /*
487 * Save off the type before doing the memcpy. Type will be set in the
488 * end after completing all initialization for the new device.
489 */
490 *type = dd_config->type;
491 dd_config->type = 0;
492 memcpy(devp, dd_config, mic_desc_size(dd_config));
493
494 *devpage = devp;
495exit:
496 kfree(dd_config);
497 return ret;
498}
499
500static void mic_init_device_ctrl(struct mic_vdev *mvdev,
501 struct mic_device_desc *devpage)
502{
503 struct mic_device_ctrl *dc;
504
Ashutosh Dixitced2c602013-09-27 09:49:53 -0700505 dc = (void *)devpage + mic_aligned_desc_size(devpage);
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700506
507 dc->config_change = 0;
508 dc->guest_ack = 0;
509 dc->vdev_reset = 0;
510 dc->host_ack = 0;
511 dc->used_address_updated = 0;
512 dc->c2h_vdev_db = -1;
513 dc->h2c_vdev_db = -1;
Ashutosh Dixitced2c602013-09-27 09:49:53 -0700514 mvdev->dc = dc;
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700515}
516
517int mic_virtio_add_device(struct mic_vdev *mvdev,
518 void __user *argp)
519{
520 struct mic_device *mdev = mvdev->mdev;
Ashutosh Dixit42579222013-10-29 17:09:59 -0700521 struct mic_device_desc *dd = NULL;
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700522 struct mic_vqconfig *vqconfig;
523 int vr_size, i, j, ret;
Ashutosh Dixit42579222013-10-29 17:09:59 -0700524 u8 type = 0;
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700525 s8 db;
526 char irqname[10];
527 struct mic_bootparam *bootparam = mdev->dp;
528 u16 num;
Ashutosh Dixit173c0722013-11-27 08:58:42 -0800529 dma_addr_t vr_addr;
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700530
531 mutex_lock(&mdev->mic_mutex);
532
533 ret = mic_copy_dp_entry(mvdev, argp, &type, &dd);
534 if (ret) {
535 mutex_unlock(&mdev->mic_mutex);
536 return ret;
537 }
538
539 mic_init_device_ctrl(mvdev, dd);
540
541 mvdev->dd = dd;
542 mvdev->virtio_id = type;
543 vqconfig = mic_vq_config(dd);
544 INIT_WORK(&mvdev->virtio_bh_work, mic_bh_handler);
545
546 for (i = 0; i < dd->num_vq; i++) {
547 struct mic_vringh *mvr = &mvdev->mvr[i];
548 struct mic_vring *vr = &mvdev->mvr[i].vring;
549 num = le16_to_cpu(vqconfig[i].num);
550 mutex_init(&mvr->vr_mutex);
551 vr_size = PAGE_ALIGN(vring_size(num, MIC_VIRTIO_RING_ALIGN) +
552 sizeof(struct _mic_vring_info));
553 vr->va = (void *)
554 __get_free_pages(GFP_KERNEL | __GFP_ZERO,
Ashutosh Dixitced2c602013-09-27 09:49:53 -0700555 get_order(vr_size));
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700556 if (!vr->va) {
557 ret = -ENOMEM;
558 dev_err(mic_dev(mvdev), "%s %d err %d\n",
559 __func__, __LINE__, ret);
560 goto err;
561 }
562 vr->len = vr_size;
563 vr->info = vr->va + vring_size(num, MIC_VIRTIO_RING_ALIGN);
Ashutosh Dixit173c0722013-11-27 08:58:42 -0800564 vr->info->magic = cpu_to_le32(MIC_MAGIC + mvdev->virtio_id + i);
565 vr_addr = mic_map_single(mdev, vr->va, vr_size);
566 if (mic_map_error(vr_addr)) {
Ashutosh Dixitced2c602013-09-27 09:49:53 -0700567 free_pages((unsigned long)vr->va, get_order(vr_size));
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700568 ret = -ENOMEM;
569 dev_err(mic_dev(mvdev), "%s %d err %d\n",
570 __func__, __LINE__, ret);
571 goto err;
572 }
Ashutosh Dixit173c0722013-11-27 08:58:42 -0800573 vqconfig[i].address = cpu_to_le64(vr_addr);
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700574
Ashutosh Dixitced2c602013-09-27 09:49:53 -0700575 vring_init(&vr->vr, num, vr->va, MIC_VIRTIO_RING_ALIGN);
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700576 ret = vringh_init_kern(&mvr->vrh,
577 *(u32 *)mic_vq_features(mvdev->dd), num, false,
578 vr->vr.desc, vr->vr.avail, vr->vr.used);
579 if (ret) {
580 dev_err(mic_dev(mvdev), "%s %d err %d\n",
581 __func__, __LINE__, ret);
582 goto err;
583 }
584 vringh_kiov_init(&mvr->riov, NULL, 0);
585 vringh_kiov_init(&mvr->wiov, NULL, 0);
586 mvr->head = USHRT_MAX;
587 mvr->mvdev = mvdev;
588 mvr->vrh.notify = mic_notify;
589 dev_dbg(mdev->sdev->parent,
590 "%s %d index %d va %p info %p vr_size 0x%x\n",
591 __func__, __LINE__, i, vr->va, vr->info, vr_size);
592 }
593
Ashutosh Dixitced2c602013-09-27 09:49:53 -0700594 snprintf(irqname, sizeof(irqname), "mic%dvirtio%d", mdev->id,
595 mvdev->virtio_id);
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700596 mvdev->virtio_db = mic_next_db(mdev);
597 mvdev->virtio_cookie = mic_request_irq(mdev, mic_virtio_intr_handler,
598 irqname, mvdev, mvdev->virtio_db, MIC_INTR_DB);
599 if (IS_ERR(mvdev->virtio_cookie)) {
600 ret = PTR_ERR(mvdev->virtio_cookie);
601 dev_dbg(mdev->sdev->parent, "request irq failed\n");
602 goto err;
603 }
604
605 mvdev->dc->c2h_vdev_db = mvdev->virtio_db;
606
607 list_add_tail(&mvdev->list, &mdev->vdev_list);
608 /*
609 * Order the type update with previous stores. This write barrier
610 * is paired with the corresponding read barrier before the uncached
611 * system memory read of the type, on the card while scanning the
612 * device page.
613 */
614 smp_wmb();
615 dd->type = type;
616
617 dev_dbg(mdev->sdev->parent, "Added virtio device id %d\n", dd->type);
618
619 db = bootparam->h2c_config_db;
620 if (db != -1)
621 mdev->ops->send_intr(mdev, db);
622 mutex_unlock(&mdev->mic_mutex);
623 return 0;
624err:
625 vqconfig = mic_vq_config(dd);
626 for (j = 0; j < i; j++) {
627 struct mic_vringh *mvr = &mvdev->mvr[j];
628 mic_unmap_single(mdev, le64_to_cpu(vqconfig[j].address),
Ashutosh Dixitced2c602013-09-27 09:49:53 -0700629 mvr->vring.len);
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700630 free_pages((unsigned long)mvr->vring.va,
Ashutosh Dixitced2c602013-09-27 09:49:53 -0700631 get_order(mvr->vring.len));
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700632 }
633 mutex_unlock(&mdev->mic_mutex);
634 return ret;
635}
636
637void mic_virtio_del_device(struct mic_vdev *mvdev)
638{
639 struct list_head *pos, *tmp;
640 struct mic_vdev *tmp_mvdev;
641 struct mic_device *mdev = mvdev->mdev;
642 DECLARE_WAIT_QUEUE_HEAD_ONSTACK(wake);
Sudeep Dutt9420b342013-11-27 08:58:39 -0800643 int i, ret, retry;
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700644 struct mic_vqconfig *vqconfig;
645 struct mic_bootparam *bootparam = mdev->dp;
646 s8 db;
647
648 mutex_lock(&mdev->mic_mutex);
649 db = bootparam->h2c_config_db;
650 if (db == -1)
651 goto skip_hot_remove;
652 dev_dbg(mdev->sdev->parent,
653 "Requesting hot remove id %d\n", mvdev->virtio_id);
654 mvdev->dc->config_change = MIC_VIRTIO_PARAM_DEV_REMOVE;
655 mdev->ops->send_intr(mdev, db);
Sudeep Dutt9420b342013-11-27 08:58:39 -0800656 for (retry = 100; retry--;) {
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700657 ret = wait_event_timeout(wake,
658 mvdev->dc->guest_ack, msecs_to_jiffies(100));
659 if (ret)
660 break;
661 }
662 dev_dbg(mdev->sdev->parent,
Sudeep Dutt9420b342013-11-27 08:58:39 -0800663 "Device id %d config_change %d guest_ack %d retry %d\n",
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700664 mvdev->virtio_id, mvdev->dc->config_change,
Sudeep Dutt9420b342013-11-27 08:58:39 -0800665 mvdev->dc->guest_ack, retry);
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700666 mvdev->dc->config_change = 0;
667 mvdev->dc->guest_ack = 0;
668skip_hot_remove:
669 mic_free_irq(mdev, mvdev->virtio_cookie, mvdev);
670 flush_work(&mvdev->virtio_bh_work);
671 vqconfig = mic_vq_config(mvdev->dd);
672 for (i = 0; i < mvdev->dd->num_vq; i++) {
673 struct mic_vringh *mvr = &mvdev->mvr[i];
674 vringh_kiov_cleanup(&mvr->riov);
675 vringh_kiov_cleanup(&mvr->wiov);
676 mic_unmap_single(mdev, le64_to_cpu(vqconfig[i].address),
Ashutosh Dixitced2c602013-09-27 09:49:53 -0700677 mvr->vring.len);
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700678 free_pages((unsigned long)mvr->vring.va,
Ashutosh Dixitced2c602013-09-27 09:49:53 -0700679 get_order(mvr->vring.len));
Ashutosh Dixitf69bcbf2013-09-05 16:42:18 -0700680 }
681
682 list_for_each_safe(pos, tmp, &mdev->vdev_list) {
683 tmp_mvdev = list_entry(pos, struct mic_vdev, list);
684 if (tmp_mvdev == mvdev) {
685 list_del(pos);
686 dev_dbg(mdev->sdev->parent,
687 "Removing virtio device id %d\n",
688 mvdev->virtio_id);
689 break;
690 }
691 }
692 /*
693 * Order the type update with previous stores. This write barrier
694 * is paired with the corresponding read barrier before the uncached
695 * system memory read of the type, on the card while scanning the
696 * device page.
697 */
698 smp_wmb();
699 mvdev->dd->type = -1;
700 mutex_unlock(&mdev->mic_mutex);
701}