Merge branch 'master' of /home/davem/src/GIT/linux-2.6/
[linux-2.6] / drivers / net / enic / vnic_dev.c
1 /*
2  * Copyright 2008 Cisco Systems, Inc.  All rights reserved.
3  * Copyright 2007 Nuova Systems, Inc.  All rights reserved.
4  *
5  * This program is free software; you may redistribute it and/or modify
6  * it under the terms of the GNU General Public License as published by
7  * the Free Software Foundation; version 2 of the License.
8  *
9  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
10  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
11  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
12  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
13  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
14  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
15  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
16  * SOFTWARE.
17  *
18  */
19
20 #include <linux/kernel.h>
21 #include <linux/errno.h>
22 #include <linux/types.h>
23 #include <linux/pci.h>
24 #include <linux/delay.h>
25 #include <linux/if_ether.h>
26
27 #include "vnic_resource.h"
28 #include "vnic_devcmd.h"
29 #include "vnic_dev.h"
30 #include "vnic_stats.h"
31
32 struct vnic_res {
33         void __iomem *vaddr;
34         unsigned int count;
35 };
36
37 #define VNIC_DEV_CAP_INIT       0x0001
38 #define VNIC_DEV_CAP_PERBI      0x0002
39
40 struct vnic_dev {
41         void *priv;
42         struct pci_dev *pdev;
43         struct vnic_res res[RES_TYPE_MAX];
44         enum vnic_dev_intr_mode intr_mode;
45         struct vnic_devcmd __iomem *devcmd;
46         struct vnic_devcmd_notify *notify;
47         struct vnic_devcmd_notify notify_copy;
48         dma_addr_t notify_pa;
49         u32 notify_sz;
50         u32 *linkstatus;
51         dma_addr_t linkstatus_pa;
52         struct vnic_stats *stats;
53         dma_addr_t stats_pa;
54         struct vnic_devcmd_fw_info *fw_info;
55         dma_addr_t fw_info_pa;
56         u32 cap_flags;
57 };
58
59 #define VNIC_MAX_RES_HDR_SIZE \
60         (sizeof(struct vnic_resource_header) + \
61         sizeof(struct vnic_resource) * RES_TYPE_MAX)
62 #define VNIC_RES_STRIDE 128
63
64 void *vnic_dev_priv(struct vnic_dev *vdev)
65 {
66         return vdev->priv;
67 }
68
69 static int vnic_dev_discover_res(struct vnic_dev *vdev,
70         struct vnic_dev_bar *bar)
71 {
72         struct vnic_resource_header __iomem *rh;
73         struct vnic_resource __iomem *r;
74         u8 type;
75
76         if (bar->len < VNIC_MAX_RES_HDR_SIZE) {
77                 printk(KERN_ERR "vNIC BAR0 res hdr length error\n");
78                 return -EINVAL;
79         }
80
81         rh = bar->vaddr;
82         if (!rh) {
83                 printk(KERN_ERR "vNIC BAR0 res hdr not mem-mapped\n");
84                 return -EINVAL;
85         }
86
87         if (ioread32(&rh->magic) != VNIC_RES_MAGIC ||
88             ioread32(&rh->version) != VNIC_RES_VERSION) {
89                 printk(KERN_ERR "vNIC BAR0 res magic/version error "
90                         "exp (%lx/%lx) curr (%x/%x)\n",
91                         VNIC_RES_MAGIC, VNIC_RES_VERSION,
92                         ioread32(&rh->magic), ioread32(&rh->version));
93                 return -EINVAL;
94         }
95
96         r = (struct vnic_resource __iomem *)(rh + 1);
97
98         while ((type = ioread8(&r->type)) != RES_TYPE_EOL) {
99
100                 u8 bar_num = ioread8(&r->bar);
101                 u32 bar_offset = ioread32(&r->bar_offset);
102                 u32 count = ioread32(&r->count);
103                 u32 len;
104
105                 r++;
106
107                 if (bar_num != 0)  /* only mapping in BAR0 resources */
108                         continue;
109
110                 switch (type) {
111                 case RES_TYPE_WQ:
112                 case RES_TYPE_RQ:
113                 case RES_TYPE_CQ:
114                 case RES_TYPE_INTR_CTRL:
115                         /* each count is stride bytes long */
116                         len = count * VNIC_RES_STRIDE;
117                         if (len + bar_offset > bar->len) {
118                                 printk(KERN_ERR "vNIC BAR0 resource %d "
119                                         "out-of-bounds, offset 0x%x + "
120                                         "size 0x%x > bar len 0x%lx\n",
121                                         type, bar_offset,
122                                         len,
123                                         bar->len);
124                                 return -EINVAL;
125                         }
126                         break;
127                 case RES_TYPE_INTR_PBA_LEGACY:
128                 case RES_TYPE_DEVCMD:
129                         len = count;
130                         break;
131                 default:
132                         continue;
133                 }
134
135                 vdev->res[type].count = count;
136                 vdev->res[type].vaddr = (char __iomem *)bar->vaddr + bar_offset;
137         }
138
139         return 0;
140 }
141
142 unsigned int vnic_dev_get_res_count(struct vnic_dev *vdev,
143         enum vnic_res_type type)
144 {
145         return vdev->res[type].count;
146 }
147
148 void __iomem *vnic_dev_get_res(struct vnic_dev *vdev, enum vnic_res_type type,
149         unsigned int index)
150 {
151         if (!vdev->res[type].vaddr)
152                 return NULL;
153
154         switch (type) {
155         case RES_TYPE_WQ:
156         case RES_TYPE_RQ:
157         case RES_TYPE_CQ:
158         case RES_TYPE_INTR_CTRL:
159                 return (char __iomem *)vdev->res[type].vaddr +
160                         index * VNIC_RES_STRIDE;
161         default:
162                 return (char __iomem *)vdev->res[type].vaddr;
163         }
164 }
165
166 unsigned int vnic_dev_desc_ring_size(struct vnic_dev_ring *ring,
167         unsigned int desc_count, unsigned int desc_size)
168 {
169         /* The base address of the desc rings must be 512 byte aligned.
170          * Descriptor count is aligned to groups of 32 descriptors.  A
171          * count of 0 means the maximum 4096 descriptors.  Descriptor
172          * size is aligned to 16 bytes.
173          */
174
175         unsigned int count_align = 32;
176         unsigned int desc_align = 16;
177
178         ring->base_align = 512;
179
180         if (desc_count == 0)
181                 desc_count = 4096;
182
183         ring->desc_count = ALIGN(desc_count, count_align);
184
185         ring->desc_size = ALIGN(desc_size, desc_align);
186
187         ring->size = ring->desc_count * ring->desc_size;
188         ring->size_unaligned = ring->size + ring->base_align;
189
190         return ring->size_unaligned;
191 }
192
193 void vnic_dev_clear_desc_ring(struct vnic_dev_ring *ring)
194 {
195         memset(ring->descs, 0, ring->size);
196 }
197
198 int vnic_dev_alloc_desc_ring(struct vnic_dev *vdev, struct vnic_dev_ring *ring,
199         unsigned int desc_count, unsigned int desc_size)
200 {
201         vnic_dev_desc_ring_size(ring, desc_count, desc_size);
202
203         ring->descs_unaligned = pci_alloc_consistent(vdev->pdev,
204                 ring->size_unaligned,
205                 &ring->base_addr_unaligned);
206
207         if (!ring->descs_unaligned) {
208                 printk(KERN_ERR
209                   "Failed to allocate ring (size=%d), aborting\n",
210                         (int)ring->size);
211                 return -ENOMEM;
212         }
213
214         ring->base_addr = ALIGN(ring->base_addr_unaligned,
215                 ring->base_align);
216         ring->descs = (u8 *)ring->descs_unaligned +
217                 (ring->base_addr - ring->base_addr_unaligned);
218
219         vnic_dev_clear_desc_ring(ring);
220
221         ring->desc_avail = ring->desc_count - 1;
222
223         return 0;
224 }
225
226 void vnic_dev_free_desc_ring(struct vnic_dev *vdev, struct vnic_dev_ring *ring)
227 {
228         if (ring->descs) {
229                 pci_free_consistent(vdev->pdev,
230                         ring->size_unaligned,
231                         ring->descs_unaligned,
232                         ring->base_addr_unaligned);
233                 ring->descs = NULL;
234         }
235 }
236
237 int vnic_dev_cmd(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd,
238         u64 *a0, u64 *a1, int wait)
239 {
240         struct vnic_devcmd __iomem *devcmd = vdev->devcmd;
241         int delay;
242         u32 status;
243         int err;
244
245         status = ioread32(&devcmd->status);
246         if (status & STAT_BUSY) {
247                 printk(KERN_ERR "Busy devcmd %d\n", _CMD_N(cmd));
248                 return -EBUSY;
249         }
250
251         if (_CMD_DIR(cmd) & _CMD_DIR_WRITE) {
252                 writeq(*a0, &devcmd->args[0]);
253                 writeq(*a1, &devcmd->args[1]);
254                 wmb();
255         }
256
257         iowrite32(cmd, &devcmd->cmd);
258
259         if ((_CMD_FLAGS(cmd) & _CMD_FLAGS_NOWAIT))
260                         return 0;
261
262         for (delay = 0; delay < wait; delay++) {
263
264                 udelay(100);
265
266                 status = ioread32(&devcmd->status);
267                 if (!(status & STAT_BUSY)) {
268
269                         if (status & STAT_ERROR) {
270                                 err = (int)readq(&devcmd->args[0]);
271                                 if (err != ERR_ECMDUNKNOWN ||
272                                     cmd != CMD_CAPABILITY)
273                                         printk(KERN_ERR "Error %d devcmd %d\n",
274                                                 err, _CMD_N(cmd));
275                                 return err;
276                         }
277
278                         if (_CMD_DIR(cmd) & _CMD_DIR_READ) {
279                                 rmb();
280                                 *a0 = readq(&devcmd->args[0]);
281                                 *a1 = readq(&devcmd->args[1]);
282                         }
283
284                         return 0;
285                 }
286         }
287
288         printk(KERN_ERR "Timedout devcmd %d\n", _CMD_N(cmd));
289         return -ETIMEDOUT;
290 }
291
292 static int vnic_dev_capable(struct vnic_dev *vdev, enum vnic_devcmd_cmd cmd)
293 {
294         u64 a0 = (u32)cmd, a1 = 0;
295         int wait = 1000;
296         int err;
297
298         err = vnic_dev_cmd(vdev, CMD_CAPABILITY, &a0, &a1, wait);
299
300         return !(err || a0);
301 }
302
303 int vnic_dev_fw_info(struct vnic_dev *vdev,
304         struct vnic_devcmd_fw_info **fw_info)
305 {
306         u64 a0, a1 = 0;
307         int wait = 1000;
308         int err = 0;
309
310         if (!vdev->fw_info) {
311                 vdev->fw_info = pci_alloc_consistent(vdev->pdev,
312                         sizeof(struct vnic_devcmd_fw_info),
313                         &vdev->fw_info_pa);
314                 if (!vdev->fw_info)
315                         return -ENOMEM;
316
317                 a0 = vdev->fw_info_pa;
318
319                 /* only get fw_info once and cache it */
320                 err = vnic_dev_cmd(vdev, CMD_MCPU_FW_INFO, &a0, &a1, wait);
321         }
322
323         *fw_info = vdev->fw_info;
324
325         return err;
326 }
327
328 int vnic_dev_spec(struct vnic_dev *vdev, unsigned int offset, unsigned int size,
329         void *value)
330 {
331         u64 a0, a1;
332         int wait = 1000;
333         int err;
334
335         a0 = offset;
336         a1 = size;
337
338         err = vnic_dev_cmd(vdev, CMD_DEV_SPEC, &a0, &a1, wait);
339
340         switch (size) {
341         case 1: *(u8 *)value = (u8)a0; break;
342         case 2: *(u16 *)value = (u16)a0; break;
343         case 4: *(u32 *)value = (u32)a0; break;
344         case 8: *(u64 *)value = a0; break;
345         default: BUG(); break;
346         }
347
348         return err;
349 }
350
351 int vnic_dev_stats_clear(struct vnic_dev *vdev)
352 {
353         u64 a0 = 0, a1 = 0;
354         int wait = 1000;
355         return vnic_dev_cmd(vdev, CMD_STATS_CLEAR, &a0, &a1, wait);
356 }
357
358 int vnic_dev_stats_dump(struct vnic_dev *vdev, struct vnic_stats **stats)
359 {
360         u64 a0, a1;
361         int wait = 1000;
362
363         if (!vdev->stats) {
364                 vdev->stats = pci_alloc_consistent(vdev->pdev,
365                         sizeof(struct vnic_stats), &vdev->stats_pa);
366                 if (!vdev->stats)
367                         return -ENOMEM;
368         }
369
370         *stats = vdev->stats;
371         a0 = vdev->stats_pa;
372         a1 = sizeof(struct vnic_stats);
373
374         return vnic_dev_cmd(vdev, CMD_STATS_DUMP, &a0, &a1, wait);
375 }
376
377 int vnic_dev_close(struct vnic_dev *vdev)
378 {
379         u64 a0 = 0, a1 = 0;
380         int wait = 1000;
381         return vnic_dev_cmd(vdev, CMD_CLOSE, &a0, &a1, wait);
382 }
383
384 int vnic_dev_enable(struct vnic_dev *vdev)
385 {
386         u64 a0 = 0, a1 = 0;
387         int wait = 1000;
388         return vnic_dev_cmd(vdev, CMD_ENABLE, &a0, &a1, wait);
389 }
390
391 int vnic_dev_disable(struct vnic_dev *vdev)
392 {
393         u64 a0 = 0, a1 = 0;
394         int wait = 1000;
395         return vnic_dev_cmd(vdev, CMD_DISABLE, &a0, &a1, wait);
396 }
397
398 int vnic_dev_open(struct vnic_dev *vdev, int arg)
399 {
400         u64 a0 = (u32)arg, a1 = 0;
401         int wait = 1000;
402         return vnic_dev_cmd(vdev, CMD_OPEN, &a0, &a1, wait);
403 }
404
405 int vnic_dev_open_done(struct vnic_dev *vdev, int *done)
406 {
407         u64 a0 = 0, a1 = 0;
408         int wait = 1000;
409         int err;
410
411         *done = 0;
412
413         err = vnic_dev_cmd(vdev, CMD_OPEN_STATUS, &a0, &a1, wait);
414         if (err)
415                 return err;
416
417         *done = (a0 == 0);
418
419         return 0;
420 }
421
422 int vnic_dev_soft_reset(struct vnic_dev *vdev, int arg)
423 {
424         u64 a0 = (u32)arg, a1 = 0;
425         int wait = 1000;
426         return vnic_dev_cmd(vdev, CMD_SOFT_RESET, &a0, &a1, wait);
427 }
428
429 int vnic_dev_soft_reset_done(struct vnic_dev *vdev, int *done)
430 {
431         u64 a0 = 0, a1 = 0;
432         int wait = 1000;
433         int err;
434
435         *done = 0;
436
437         err = vnic_dev_cmd(vdev, CMD_SOFT_RESET_STATUS, &a0, &a1, wait);
438         if (err)
439                 return err;
440
441         *done = (a0 == 0);
442
443         return 0;
444 }
445
446 int vnic_dev_hang_notify(struct vnic_dev *vdev)
447 {
448         u64 a0, a1;
449         int wait = 1000;
450         return vnic_dev_cmd(vdev, CMD_HANG_NOTIFY, &a0, &a1, wait);
451 }
452
453 int vnic_dev_mac_addr(struct vnic_dev *vdev, u8 *mac_addr)
454 {
455         u64 a0, a1;
456         int wait = 1000;
457         int err, i;
458
459         for (i = 0; i < ETH_ALEN; i++)
460                 mac_addr[i] = 0;
461
462         err = vnic_dev_cmd(vdev, CMD_MAC_ADDR, &a0, &a1, wait);
463         if (err)
464                 return err;
465
466         for (i = 0; i < ETH_ALEN; i++)
467                 mac_addr[i] = ((u8 *)&a0)[i];
468
469         return 0;
470 }
471
472 void vnic_dev_packet_filter(struct vnic_dev *vdev, int directed, int multicast,
473         int broadcast, int promisc, int allmulti)
474 {
475         u64 a0, a1 = 0;
476         int wait = 1000;
477         int err;
478
479         a0 = (directed ? CMD_PFILTER_DIRECTED : 0) |
480              (multicast ? CMD_PFILTER_MULTICAST : 0) |
481              (broadcast ? CMD_PFILTER_BROADCAST : 0) |
482              (promisc ? CMD_PFILTER_PROMISCUOUS : 0) |
483              (allmulti ? CMD_PFILTER_ALL_MULTICAST : 0);
484
485         err = vnic_dev_cmd(vdev, CMD_PACKET_FILTER, &a0, &a1, wait);
486         if (err)
487                 printk(KERN_ERR "Can't set packet filter\n");
488 }
489
490 void vnic_dev_add_addr(struct vnic_dev *vdev, u8 *addr)
491 {
492         u64 a0 = 0, a1 = 0;
493         int wait = 1000;
494         int err;
495         int i;
496
497         for (i = 0; i < ETH_ALEN; i++)
498                 ((u8 *)&a0)[i] = addr[i];
499
500         err = vnic_dev_cmd(vdev, CMD_ADDR_ADD, &a0, &a1, wait);
501         if (err)
502                 printk(KERN_ERR "Can't add addr [%pM], %d\n", addr, err);
503 }
504
505 void vnic_dev_del_addr(struct vnic_dev *vdev, u8 *addr)
506 {
507         u64 a0 = 0, a1 = 0;
508         int wait = 1000;
509         int err;
510         int i;
511
512         for (i = 0; i < ETH_ALEN; i++)
513                 ((u8 *)&a0)[i] = addr[i];
514
515         err = vnic_dev_cmd(vdev, CMD_ADDR_DEL, &a0, &a1, wait);
516         if (err)
517                 printk(KERN_ERR "Can't del addr [%pM], %d\n", addr, err);
518 }
519
520 int vnic_dev_notify_set(struct vnic_dev *vdev, u16 intr)
521 {
522         u64 a0, a1;
523         int wait = 1000;
524         int r;
525
526         if (!vdev->notify) {
527                 vdev->notify = pci_alloc_consistent(vdev->pdev,
528                         sizeof(struct vnic_devcmd_notify),
529                         &vdev->notify_pa);
530                 if (!vdev->notify)
531                         return -ENOMEM;
532                 memset(vdev->notify, 0, sizeof(struct vnic_devcmd_notify));
533         }
534
535         a0 = vdev->notify_pa;
536         a1 = ((u64)intr << 32) & 0x0000ffff00000000ULL;
537         a1 += sizeof(struct vnic_devcmd_notify);
538
539         r = vnic_dev_cmd(vdev, CMD_NOTIFY, &a0, &a1, wait);
540         vdev->notify_sz = (r == 0) ? (u32)a1 : 0;
541         return r;
542 }
543
544 void vnic_dev_notify_unset(struct vnic_dev *vdev)
545 {
546         u64 a0, a1;
547         int wait = 1000;
548
549         a0 = 0;  /* paddr = 0 to unset notify buffer */
550         a1 = 0x0000ffff00000000ULL; /* intr num = -1 to unreg for intr */
551         a1 += sizeof(struct vnic_devcmd_notify);
552
553         vnic_dev_cmd(vdev, CMD_NOTIFY, &a0, &a1, wait);
554         vdev->notify_sz = 0;
555 }
556
557 static int vnic_dev_notify_ready(struct vnic_dev *vdev)
558 {
559         u32 *words;
560         unsigned int nwords = vdev->notify_sz / 4;
561         unsigned int i;
562         u32 csum;
563
564         if (!vdev->notify || !vdev->notify_sz)
565                 return 0;
566
567         do {
568                 csum = 0;
569                 memcpy(&vdev->notify_copy, vdev->notify, vdev->notify_sz);
570                 words = (u32 *)&vdev->notify_copy;
571                 for (i = 1; i < nwords; i++)
572                         csum += words[i];
573         } while (csum != words[0]);
574
575         return 1;
576 }
577
578 int vnic_dev_init(struct vnic_dev *vdev, int arg)
579 {
580         u64 a0 = (u32)arg, a1 = 0;
581         int wait = 1000;
582         int r = 0;
583
584         if (vdev->cap_flags & VNIC_DEV_CAP_INIT)
585                 r = vnic_dev_cmd(vdev, CMD_INIT, &a0, &a1, wait);
586         else {
587                 vnic_dev_cmd(vdev, CMD_INIT_v1, &a0, &a1, wait);
588                 if (a0 & CMD_INITF_DEFAULT_MAC) {
589                         // Emulate these for old CMD_INIT_v1 which
590                         // didn't pass a0 so no CMD_INITF_*.
591                         vnic_dev_cmd(vdev, CMD_MAC_ADDR, &a0, &a1, wait);
592                         vnic_dev_cmd(vdev, CMD_ADDR_ADD, &a0, &a1, wait);
593                 }
594         }
595         return r;
596 }
597
598 int vnic_dev_link_status(struct vnic_dev *vdev)
599 {
600         if (vdev->linkstatus)
601                 return *vdev->linkstatus;
602
603         if (!vnic_dev_notify_ready(vdev))
604                 return 0;
605
606         return vdev->notify_copy.link_state;
607 }
608
609 u32 vnic_dev_port_speed(struct vnic_dev *vdev)
610 {
611         if (!vnic_dev_notify_ready(vdev))
612                 return 0;
613
614         return vdev->notify_copy.port_speed;
615 }
616
617 u32 vnic_dev_msg_lvl(struct vnic_dev *vdev)
618 {
619         if (!vnic_dev_notify_ready(vdev))
620                 return 0;
621
622         return vdev->notify_copy.msglvl;
623 }
624
625 u32 vnic_dev_mtu(struct vnic_dev *vdev)
626 {
627         if (!vnic_dev_notify_ready(vdev))
628                 return 0;
629
630         return vdev->notify_copy.mtu;
631 }
632
633 u32 vnic_dev_link_down_cnt(struct vnic_dev *vdev)
634 {
635         if (!vnic_dev_notify_ready(vdev))
636                 return 0;
637
638         return vdev->notify_copy.link_down_cnt;
639 }
640
641 u32 vnic_dev_notify_status(struct vnic_dev *vdev)
642 {
643         if (!vnic_dev_notify_ready(vdev))
644                 return 0;
645
646         return vdev->notify_copy.status;
647 }
648
649 void vnic_dev_set_intr_mode(struct vnic_dev *vdev,
650         enum vnic_dev_intr_mode intr_mode)
651 {
652         vdev->intr_mode = intr_mode;
653 }
654
655 enum vnic_dev_intr_mode vnic_dev_get_intr_mode(
656         struct vnic_dev *vdev)
657 {
658         return vdev->intr_mode;
659 }
660
661 void vnic_dev_unregister(struct vnic_dev *vdev)
662 {
663         if (vdev) {
664                 if (vdev->notify)
665                         pci_free_consistent(vdev->pdev,
666                                 sizeof(struct vnic_devcmd_notify),
667                                 vdev->notify,
668                                 vdev->notify_pa);
669                 if (vdev->linkstatus)
670                         pci_free_consistent(vdev->pdev,
671                                 sizeof(u32),
672                                 vdev->linkstatus,
673                                 vdev->linkstatus_pa);
674                 if (vdev->stats)
675                         pci_free_consistent(vdev->pdev,
676                                 sizeof(struct vnic_dev),
677                                 vdev->stats, vdev->stats_pa);
678                 if (vdev->fw_info)
679                         pci_free_consistent(vdev->pdev,
680                                 sizeof(struct vnic_devcmd_fw_info),
681                                 vdev->fw_info, vdev->fw_info_pa);
682                 kfree(vdev);
683         }
684 }
685
686 struct vnic_dev *vnic_dev_register(struct vnic_dev *vdev,
687         void *priv, struct pci_dev *pdev, struct vnic_dev_bar *bar)
688 {
689         if (!vdev) {
690                 vdev = kzalloc(sizeof(struct vnic_dev), GFP_ATOMIC);
691                 if (!vdev)
692                         return NULL;
693         }
694
695         vdev->priv = priv;
696         vdev->pdev = pdev;
697
698         if (vnic_dev_discover_res(vdev, bar))
699                 goto err_out;
700
701         vdev->devcmd = vnic_dev_get_res(vdev, RES_TYPE_DEVCMD, 0);
702         if (!vdev->devcmd)
703                 goto err_out;
704
705         vdev->cap_flags = 0;
706
707         if (vnic_dev_capable(vdev, CMD_INIT))
708                 vdev->cap_flags |= VNIC_DEV_CAP_INIT;
709
710         return vdev;
711
712 err_out:
713         vnic_dev_unregister(vdev);
714         return NULL;
715 }
716
717