service: add count per lcore
[dpdk.git] / lib / librte_eal / linuxapp / eal / eal_pci.c
1 /*-
2  *   BSD LICENSE
3  *
4  *   Copyright(c) 2010-2014 Intel Corporation. All rights reserved.
5  *   All rights reserved.
6  *
7  *   Redistribution and use in source and binary forms, with or without
8  *   modification, are permitted provided that the following conditions
9  *   are met:
10  *
11  *     * Redistributions of source code must retain the above copyright
12  *       notice, this list of conditions and the following disclaimer.
13  *     * Redistributions in binary form must reproduce the above copyright
14  *       notice, this list of conditions and the following disclaimer in
15  *       the documentation and/or other materials provided with the
16  *       distribution.
17  *     * Neither the name of Intel Corporation nor the names of its
18  *       contributors may be used to endorse or promote products derived
19  *       from this software without specific prior written permission.
20  *
21  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
24  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
25  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
26  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
27  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
28  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
29  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
30  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
31  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
32  */
33
34 #include <string.h>
35 #include <dirent.h>
36
37 #include <rte_log.h>
38 #include <rte_bus.h>
39 #include <rte_pci.h>
40 #include <rte_eal_memconfig.h>
41 #include <rte_malloc.h>
42 #include <rte_devargs.h>
43 #include <rte_memcpy.h>
44
45 #include "eal_filesystem.h"
46 #include "eal_private.h"
47 #include "eal_pci_init.h"
48
49 /**
50  * @file
51  * PCI probing under linux
52  *
53  * This code is used to simulate a PCI probe by parsing information in sysfs.
54  * When a registered device matches a driver, it is then initialized with
55  * IGB_UIO driver (or doesn't initialize, if the device wasn't bound to it).
56  */
57
58 extern struct rte_pci_bus rte_pci_bus;
59
60 static int
61 pci_get_kernel_driver_by_path(const char *filename, char *dri_name)
62 {
63         int count;
64         char path[PATH_MAX];
65         char *name;
66
67         if (!filename || !dri_name)
68                 return -1;
69
70         count = readlink(filename, path, PATH_MAX);
71         if (count >= PATH_MAX)
72                 return -1;
73
74         /* For device does not have a driver */
75         if (count < 0)
76                 return 1;
77
78         path[count] = '\0';
79
80         name = strrchr(path, '/');
81         if (name) {
82                 strncpy(dri_name, name + 1, strlen(name + 1) + 1);
83                 return 0;
84         }
85
86         return -1;
87 }
88
89 /* Map pci device */
90 int
91 rte_pci_map_device(struct rte_pci_device *dev)
92 {
93         int ret = -1;
94
95         /* try mapping the NIC resources using VFIO if it exists */
96         switch (dev->kdrv) {
97         case RTE_KDRV_VFIO:
98 #ifdef VFIO_PRESENT
99                 if (pci_vfio_is_enabled())
100                         ret = pci_vfio_map_resource(dev);
101 #endif
102                 break;
103         case RTE_KDRV_IGB_UIO:
104         case RTE_KDRV_UIO_GENERIC:
105                 if (rte_eal_using_phys_addrs()) {
106                         /* map resources for devices that use uio */
107                         ret = pci_uio_map_resource(dev);
108                 }
109                 break;
110         default:
111                 RTE_LOG(DEBUG, EAL,
112                         "  Not managed by a supported kernel driver, skipped\n");
113                 ret = 1;
114                 break;
115         }
116
117         return ret;
118 }
119
120 /* Unmap pci device */
121 void
122 rte_pci_unmap_device(struct rte_pci_device *dev)
123 {
124         /* try unmapping the NIC resources using VFIO if it exists */
125         switch (dev->kdrv) {
126         case RTE_KDRV_VFIO:
127 #ifdef VFIO_PRESENT
128                 if (pci_vfio_is_enabled())
129                         pci_vfio_unmap_resource(dev);
130 #endif
131                 break;
132         case RTE_KDRV_IGB_UIO:
133         case RTE_KDRV_UIO_GENERIC:
134                 /* unmap resources for devices that use uio */
135                 pci_uio_unmap_resource(dev);
136                 break;
137         default:
138                 RTE_LOG(DEBUG, EAL,
139                         "  Not managed by a supported kernel driver, skipped\n");
140                 break;
141         }
142 }
143
144 void *
145 pci_find_max_end_va(void)
146 {
147         const struct rte_memseg *seg = rte_eal_get_physmem_layout();
148         const struct rte_memseg *last = seg;
149         unsigned i = 0;
150
151         for (i = 0; i < RTE_MAX_MEMSEG; i++, seg++) {
152                 if (seg->addr == NULL)
153                         break;
154
155                 if (seg->addr > last->addr)
156                         last = seg;
157
158         }
159         return RTE_PTR_ADD(last->addr, last->len);
160 }
161
162 /* parse one line of the "resource" sysfs file (note that the 'line'
163  * string is modified)
164  */
165 int
166 pci_parse_one_sysfs_resource(char *line, size_t len, uint64_t *phys_addr,
167         uint64_t *end_addr, uint64_t *flags)
168 {
169         union pci_resource_info {
170                 struct {
171                         char *phys_addr;
172                         char *end_addr;
173                         char *flags;
174                 };
175                 char *ptrs[PCI_RESOURCE_FMT_NVAL];
176         } res_info;
177
178         if (rte_strsplit(line, len, res_info.ptrs, 3, ' ') != 3) {
179                 RTE_LOG(ERR, EAL,
180                         "%s(): bad resource format\n", __func__);
181                 return -1;
182         }
183         errno = 0;
184         *phys_addr = strtoull(res_info.phys_addr, NULL, 16);
185         *end_addr = strtoull(res_info.end_addr, NULL, 16);
186         *flags = strtoull(res_info.flags, NULL, 16);
187         if (errno != 0) {
188                 RTE_LOG(ERR, EAL,
189                         "%s(): bad resource format\n", __func__);
190                 return -1;
191         }
192
193         return 0;
194 }
195
196 /* parse the "resource" sysfs file */
197 static int
198 pci_parse_sysfs_resource(const char *filename, struct rte_pci_device *dev)
199 {
200         FILE *f;
201         char buf[BUFSIZ];
202         int i;
203         uint64_t phys_addr, end_addr, flags;
204
205         f = fopen(filename, "r");
206         if (f == NULL) {
207                 RTE_LOG(ERR, EAL, "Cannot open sysfs resource\n");
208                 return -1;
209         }
210
211         for (i = 0; i<PCI_MAX_RESOURCE; i++) {
212
213                 if (fgets(buf, sizeof(buf), f) == NULL) {
214                         RTE_LOG(ERR, EAL,
215                                 "%s(): cannot read resource\n", __func__);
216                         goto error;
217                 }
218                 if (pci_parse_one_sysfs_resource(buf, sizeof(buf), &phys_addr,
219                                 &end_addr, &flags) < 0)
220                         goto error;
221
222                 if (flags & IORESOURCE_MEM) {
223                         dev->mem_resource[i].phys_addr = phys_addr;
224                         dev->mem_resource[i].len = end_addr - phys_addr + 1;
225                         /* not mapped for now */
226                         dev->mem_resource[i].addr = NULL;
227                 }
228         }
229         fclose(f);
230         return 0;
231
232 error:
233         fclose(f);
234         return -1;
235 }
236
237 /* Scan one pci sysfs entry, and fill the devices list from it. */
238 static int
239 pci_scan_one(const char *dirname, const struct rte_pci_addr *addr)
240 {
241         char filename[PATH_MAX];
242         unsigned long tmp;
243         struct rte_pci_device *dev;
244         char driver[PATH_MAX];
245         int ret;
246
247         dev = malloc(sizeof(*dev));
248         if (dev == NULL)
249                 return -1;
250
251         memset(dev, 0, sizeof(*dev));
252         dev->addr = *addr;
253
254         /* get vendor id */
255         snprintf(filename, sizeof(filename), "%s/vendor", dirname);
256         if (eal_parse_sysfs_value(filename, &tmp) < 0) {
257                 free(dev);
258                 return -1;
259         }
260         dev->id.vendor_id = (uint16_t)tmp;
261
262         /* get device id */
263         snprintf(filename, sizeof(filename), "%s/device", dirname);
264         if (eal_parse_sysfs_value(filename, &tmp) < 0) {
265                 free(dev);
266                 return -1;
267         }
268         dev->id.device_id = (uint16_t)tmp;
269
270         /* get subsystem_vendor id */
271         snprintf(filename, sizeof(filename), "%s/subsystem_vendor",
272                  dirname);
273         if (eal_parse_sysfs_value(filename, &tmp) < 0) {
274                 free(dev);
275                 return -1;
276         }
277         dev->id.subsystem_vendor_id = (uint16_t)tmp;
278
279         /* get subsystem_device id */
280         snprintf(filename, sizeof(filename), "%s/subsystem_device",
281                  dirname);
282         if (eal_parse_sysfs_value(filename, &tmp) < 0) {
283                 free(dev);
284                 return -1;
285         }
286         dev->id.subsystem_device_id = (uint16_t)tmp;
287
288         /* get class_id */
289         snprintf(filename, sizeof(filename), "%s/class",
290                  dirname);
291         if (eal_parse_sysfs_value(filename, &tmp) < 0) {
292                 free(dev);
293                 return -1;
294         }
295         /* the least 24 bits are valid: class, subclass, program interface */
296         dev->id.class_id = (uint32_t)tmp & RTE_CLASS_ANY_ID;
297
298         /* get max_vfs */
299         dev->max_vfs = 0;
300         snprintf(filename, sizeof(filename), "%s/max_vfs", dirname);
301         if (!access(filename, F_OK) &&
302             eal_parse_sysfs_value(filename, &tmp) == 0)
303                 dev->max_vfs = (uint16_t)tmp;
304         else {
305                 /* for non igb_uio driver, need kernel version >= 3.8 */
306                 snprintf(filename, sizeof(filename),
307                          "%s/sriov_numvfs", dirname);
308                 if (!access(filename, F_OK) &&
309                     eal_parse_sysfs_value(filename, &tmp) == 0)
310                         dev->max_vfs = (uint16_t)tmp;
311         }
312
313         /* get numa node, default to 0 if not present */
314         snprintf(filename, sizeof(filename), "%s/numa_node",
315                  dirname);
316
317         if (access(filename, F_OK) != -1) {
318                 if (eal_parse_sysfs_value(filename, &tmp) == 0)
319                         dev->device.numa_node = tmp;
320                 else
321                         dev->device.numa_node = -1;
322         } else {
323                 dev->device.numa_node = 0;
324         }
325
326         pci_name_set(dev);
327
328         /* parse resources */
329         snprintf(filename, sizeof(filename), "%s/resource", dirname);
330         if (pci_parse_sysfs_resource(filename, dev) < 0) {
331                 RTE_LOG(ERR, EAL, "%s(): cannot parse resource\n", __func__);
332                 free(dev);
333                 return -1;
334         }
335
336         /* parse driver */
337         snprintf(filename, sizeof(filename), "%s/driver", dirname);
338         ret = pci_get_kernel_driver_by_path(filename, driver);
339         if (ret < 0) {
340                 RTE_LOG(ERR, EAL, "Fail to get kernel driver\n");
341                 free(dev);
342                 return -1;
343         }
344
345         if (!ret) {
346                 if (!strcmp(driver, "vfio-pci"))
347                         dev->kdrv = RTE_KDRV_VFIO;
348                 else if (!strcmp(driver, "igb_uio"))
349                         dev->kdrv = RTE_KDRV_IGB_UIO;
350                 else if (!strcmp(driver, "uio_pci_generic"))
351                         dev->kdrv = RTE_KDRV_UIO_GENERIC;
352                 else
353                         dev->kdrv = RTE_KDRV_UNKNOWN;
354         } else
355                 dev->kdrv = RTE_KDRV_NONE;
356
357         /* device is valid, add in list (sorted) */
358         if (TAILQ_EMPTY(&rte_pci_bus.device_list)) {
359                 rte_pci_add_device(dev);
360         } else {
361                 struct rte_pci_device *dev2;
362                 int ret;
363
364                 TAILQ_FOREACH(dev2, &rte_pci_bus.device_list, next) {
365                         ret = rte_eal_compare_pci_addr(&dev->addr, &dev2->addr);
366                         if (ret > 0)
367                                 continue;
368
369                         if (ret < 0) {
370                                 rte_pci_insert_device(dev2, dev);
371                         } else { /* already registered */
372                                 dev2->kdrv = dev->kdrv;
373                                 dev2->max_vfs = dev->max_vfs;
374                                 pci_name_set(dev2);
375                                 memmove(dev2->mem_resource, dev->mem_resource,
376                                         sizeof(dev->mem_resource));
377                                 free(dev);
378                         }
379                         return 0;
380                 }
381
382                 rte_pci_add_device(dev);
383         }
384
385         return 0;
386 }
387
388 int
389 pci_update_device(const struct rte_pci_addr *addr)
390 {
391         char filename[PATH_MAX];
392
393         snprintf(filename, sizeof(filename), "%s/" PCI_PRI_FMT,
394                  pci_get_sysfs_path(), addr->domain, addr->bus, addr->devid,
395                  addr->function);
396
397         return pci_scan_one(filename, addr);
398 }
399
400 /*
401  * split up a pci address into its constituent parts.
402  */
403 static int
404 parse_pci_addr_format(const char *buf, int bufsize, struct rte_pci_addr *addr)
405 {
406         /* first split on ':' */
407         union splitaddr {
408                 struct {
409                         char *domain;
410                         char *bus;
411                         char *devid;
412                         char *function;
413                 };
414                 char *str[PCI_FMT_NVAL]; /* last element-separator is "." not ":" */
415         } splitaddr;
416
417         char *buf_copy = strndup(buf, bufsize);
418         if (buf_copy == NULL)
419                 return -1;
420
421         if (rte_strsplit(buf_copy, bufsize, splitaddr.str, PCI_FMT_NVAL, ':')
422                         != PCI_FMT_NVAL - 1)
423                 goto error;
424         /* final split is on '.' between devid and function */
425         splitaddr.function = strchr(splitaddr.devid,'.');
426         if (splitaddr.function == NULL)
427                 goto error;
428         *splitaddr.function++ = '\0';
429
430         /* now convert to int values */
431         errno = 0;
432         addr->domain = strtoul(splitaddr.domain, NULL, 16);
433         addr->bus = strtoul(splitaddr.bus, NULL, 16);
434         addr->devid = strtoul(splitaddr.devid, NULL, 16);
435         addr->function = strtoul(splitaddr.function, NULL, 10);
436         if (errno != 0)
437                 goto error;
438
439         free(buf_copy); /* free the copy made with strdup */
440         return 0;
441 error:
442         free(buf_copy);
443         return -1;
444 }
445
446 /*
447  * Scan the content of the PCI bus, and the devices in the devices
448  * list
449  */
450 int
451 rte_pci_scan(void)
452 {
453         struct dirent *e;
454         DIR *dir;
455         char dirname[PATH_MAX];
456         struct rte_pci_addr addr;
457
458         /* for debug purposes, PCI can be disabled */
459         if (internal_config.no_pci)
460                 return 0;
461
462         dir = opendir(pci_get_sysfs_path());
463         if (dir == NULL) {
464                 RTE_LOG(ERR, EAL, "%s(): opendir failed: %s\n",
465                         __func__, strerror(errno));
466                 return -1;
467         }
468
469         while ((e = readdir(dir)) != NULL) {
470                 if (e->d_name[0] == '.')
471                         continue;
472
473                 if (parse_pci_addr_format(e->d_name, sizeof(e->d_name), &addr) != 0)
474                         continue;
475
476                 snprintf(dirname, sizeof(dirname), "%s/%s",
477                                 pci_get_sysfs_path(), e->d_name);
478
479                 if (pci_scan_one(dirname, &addr) < 0)
480                         goto error;
481         }
482         closedir(dir);
483         return 0;
484
485 error:
486         closedir(dir);
487         return -1;
488 }
489
490 /* Read PCI config space. */
491 int rte_pci_read_config(const struct rte_pci_device *device,
492                 void *buf, size_t len, off_t offset)
493 {
494         const struct rte_intr_handle *intr_handle = &device->intr_handle;
495
496         switch (intr_handle->type) {
497         case RTE_INTR_HANDLE_UIO:
498         case RTE_INTR_HANDLE_UIO_INTX:
499                 return pci_uio_read_config(intr_handle, buf, len, offset);
500
501 #ifdef VFIO_PRESENT
502         case RTE_INTR_HANDLE_VFIO_MSIX:
503         case RTE_INTR_HANDLE_VFIO_MSI:
504         case RTE_INTR_HANDLE_VFIO_LEGACY:
505                 return pci_vfio_read_config(intr_handle, buf, len, offset);
506 #endif
507         default:
508                 RTE_LOG(ERR, EAL,
509                         "Unknown handle type of fd %d\n",
510                                         intr_handle->fd);
511                 return -1;
512         }
513 }
514
515 /* Write PCI config space. */
516 int rte_pci_write_config(const struct rte_pci_device *device,
517                 const void *buf, size_t len, off_t offset)
518 {
519         const struct rte_intr_handle *intr_handle = &device->intr_handle;
520
521         switch (intr_handle->type) {
522         case RTE_INTR_HANDLE_UIO:
523         case RTE_INTR_HANDLE_UIO_INTX:
524                 return pci_uio_write_config(intr_handle, buf, len, offset);
525
526 #ifdef VFIO_PRESENT
527         case RTE_INTR_HANDLE_VFIO_MSIX:
528         case RTE_INTR_HANDLE_VFIO_MSI:
529         case RTE_INTR_HANDLE_VFIO_LEGACY:
530                 return pci_vfio_write_config(intr_handle, buf, len, offset);
531 #endif
532         default:
533                 RTE_LOG(ERR, EAL,
534                         "Unknown handle type of fd %d\n",
535                                         intr_handle->fd);
536                 return -1;
537         }
538 }
539
540 #if defined(RTE_ARCH_X86)
541 static int
542 pci_ioport_map(struct rte_pci_device *dev, int bar __rte_unused,
543                 struct rte_pci_ioport *p)
544 {
545         uint16_t start, end;
546         FILE *fp;
547         char *line = NULL;
548         char pci_id[16];
549         int found = 0;
550         size_t linesz;
551
552         snprintf(pci_id, sizeof(pci_id), PCI_PRI_FMT,
553                  dev->addr.domain, dev->addr.bus,
554                  dev->addr.devid, dev->addr.function);
555
556         fp = fopen("/proc/ioports", "r");
557         if (fp == NULL) {
558                 RTE_LOG(ERR, EAL, "%s(): can't open ioports\n", __func__);
559                 return -1;
560         }
561
562         while (getdelim(&line, &linesz, '\n', fp) > 0) {
563                 char *ptr = line;
564                 char *left;
565                 int n;
566
567                 n = strcspn(ptr, ":");
568                 ptr[n] = 0;
569                 left = &ptr[n + 1];
570
571                 while (*left && isspace(*left))
572                         left++;
573
574                 if (!strncmp(left, pci_id, strlen(pci_id))) {
575                         found = 1;
576
577                         while (*ptr && isspace(*ptr))
578                                 ptr++;
579
580                         sscanf(ptr, "%04hx-%04hx", &start, &end);
581
582                         break;
583                 }
584         }
585
586         free(line);
587         fclose(fp);
588
589         if (!found)
590                 return -1;
591
592         dev->intr_handle.type = RTE_INTR_HANDLE_UNKNOWN;
593         p->base = start;
594         RTE_LOG(DEBUG, EAL, "PCI Port IO found start=0x%x\n", start);
595
596         return 0;
597 }
598 #endif
599
600 int
601 rte_pci_ioport_map(struct rte_pci_device *dev, int bar,
602                 struct rte_pci_ioport *p)
603 {
604         int ret = -1;
605
606         switch (dev->kdrv) {
607 #ifdef VFIO_PRESENT
608         case RTE_KDRV_VFIO:
609                 if (pci_vfio_is_enabled())
610                         ret = pci_vfio_ioport_map(dev, bar, p);
611                 break;
612 #endif
613         case RTE_KDRV_IGB_UIO:
614                 ret = pci_uio_ioport_map(dev, bar, p);
615                 break;
616         case RTE_KDRV_UIO_GENERIC:
617 #if defined(RTE_ARCH_X86)
618                 ret = pci_ioport_map(dev, bar, p);
619 #else
620                 ret = pci_uio_ioport_map(dev, bar, p);
621 #endif
622                 break;
623         case RTE_KDRV_NONE:
624 #if defined(RTE_ARCH_X86)
625                 ret = pci_ioport_map(dev, bar, p);
626 #endif
627                 break;
628         default:
629                 break;
630         }
631
632         if (!ret)
633                 p->dev = dev;
634
635         return ret;
636 }
637
638 void
639 rte_pci_ioport_read(struct rte_pci_ioport *p,
640                 void *data, size_t len, off_t offset)
641 {
642         switch (p->dev->kdrv) {
643 #ifdef VFIO_PRESENT
644         case RTE_KDRV_VFIO:
645                 pci_vfio_ioport_read(p, data, len, offset);
646                 break;
647 #endif
648         case RTE_KDRV_IGB_UIO:
649                 pci_uio_ioport_read(p, data, len, offset);
650                 break;
651         case RTE_KDRV_UIO_GENERIC:
652                 pci_uio_ioport_read(p, data, len, offset);
653                 break;
654         case RTE_KDRV_NONE:
655 #if defined(RTE_ARCH_X86)
656                 pci_uio_ioport_read(p, data, len, offset);
657 #endif
658                 break;
659         default:
660                 break;
661         }
662 }
663
664 void
665 rte_pci_ioport_write(struct rte_pci_ioport *p,
666                 const void *data, size_t len, off_t offset)
667 {
668         switch (p->dev->kdrv) {
669 #ifdef VFIO_PRESENT
670         case RTE_KDRV_VFIO:
671                 pci_vfio_ioport_write(p, data, len, offset);
672                 break;
673 #endif
674         case RTE_KDRV_IGB_UIO:
675                 pci_uio_ioport_write(p, data, len, offset);
676                 break;
677         case RTE_KDRV_UIO_GENERIC:
678                 pci_uio_ioport_write(p, data, len, offset);
679                 break;
680         case RTE_KDRV_NONE:
681 #if defined(RTE_ARCH_X86)
682                 pci_uio_ioport_write(p, data, len, offset);
683 #endif
684                 break;
685         default:
686                 break;
687         }
688 }
689
690 int
691 rte_pci_ioport_unmap(struct rte_pci_ioport *p)
692 {
693         int ret = -1;
694
695         switch (p->dev->kdrv) {
696 #ifdef VFIO_PRESENT
697         case RTE_KDRV_VFIO:
698                 if (pci_vfio_is_enabled())
699                         ret = pci_vfio_ioport_unmap(p);
700                 break;
701 #endif
702         case RTE_KDRV_IGB_UIO:
703                 ret = pci_uio_ioport_unmap(p);
704                 break;
705         case RTE_KDRV_UIO_GENERIC:
706 #if defined(RTE_ARCH_X86)
707                 ret = 0;
708 #else
709                 ret = pci_uio_ioport_unmap(p);
710 #endif
711                 break;
712         case RTE_KDRV_NONE:
713 #if defined(RTE_ARCH_X86)
714                 ret = 0;
715 #endif
716                 break;
717         default:
718                 break;
719         }
720
721         return ret;
722 }