drivers/raw/ifpga/ifpga_rawdev.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2010-2018 Intel Corporation
   3  */
   4
   5 #include <string.h>
   6 #include <dirent.h>
   7 #include <sys/stat.h>
   8 #include <unistd.h>
   9 #include <sys/types.h>
  10 #include <fcntl.h>
  11 #include <sys/ioctl.h>
  12 #include <sys/epoll.h>
  13 #include <rte_log.h>
  14 #include <rte_bus.h>
  15 #include <rte_malloc.h>
  16 #include <rte_devargs.h>
  17 #include <rte_memcpy.h>
  18 #include <rte_pci.h>
  19 #include <rte_bus_pci.h>
  20 #include <rte_kvargs.h>
  21 #include <rte_alarm.h>
  22 #include <rte_interrupts.h>
  23 #include <rte_errno.h>
  24 #include <rte_per_lcore.h>
  25 #include <rte_memory.h>
  26 #include <rte_memzone.h>
  27 #include <rte_eal.h>
  28 #include <rte_common.h>
  29 #include <rte_bus_vdev.h>
  30 #include <rte_string_fns.h>
  31 #include <rte_pmd_i40e.h>
  32
  33 #include "base/opae_hw_api.h"
  34 #include "base/opae_ifpga_hw_api.h"
  35 #include "base/ifpga_api.h"
  36 #include "rte_rawdev.h"
  37 #include "rte_rawdev_pmd.h"
  38 #include "rte_bus_ifpga.h"
  39 #include "ifpga_common.h"
  40 #include "ifpga_logs.h"
  41 #include "ifpga_rawdev.h"
  42 #include "ipn3ke_rawdev_api.h"
  43
  44 #define PCI_VENDOR_ID_INTEL          0x8086
  45 /* PCI Device ID */
  46 #define PCIE_DEVICE_ID_PF_INT_5_X    0xBCBD
  47 #define PCIE_DEVICE_ID_PF_INT_6_X    0xBCC0
  48 #define PCIE_DEVICE_ID_PF_DSC_1_X    0x09C4
  49 #define PCIE_DEVICE_ID_PAC_N3000     0x0B30
  50 /* VF Device */
  51 #define PCIE_DEVICE_ID_VF_INT_5_X    0xBCBF
  52 #define PCIE_DEVICE_ID_VF_INT_6_X    0xBCC1
  53 #define PCIE_DEVICE_ID_VF_DSC_1_X    0x09C5
  54 #define PCIE_DEVICE_ID_VF_PAC_N3000  0x0B31
  55 #define RTE_MAX_RAW_DEVICE           10
  56
  57 static const struct rte_pci_id pci_ifpga_map[] = {
  58         { RTE_PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCIE_DEVICE_ID_PF_INT_5_X) },
  59         { RTE_PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCIE_DEVICE_ID_VF_INT_5_X) },
  60         { RTE_PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCIE_DEVICE_ID_PF_INT_6_X) },
  61         { RTE_PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCIE_DEVICE_ID_VF_INT_6_X) },
  62         { RTE_PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCIE_DEVICE_ID_PF_DSC_1_X) },
  63         { RTE_PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCIE_DEVICE_ID_VF_DSC_1_X) },
  64         { RTE_PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCIE_DEVICE_ID_PAC_N3000),},
  65         { RTE_PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCIE_DEVICE_ID_VF_PAC_N3000),},
  66         { .vendor_id = 0, /* sentinel */ },
  67 };
  68
  69 static struct ifpga_rawdev ifpga_rawdevices[IFPGA_RAWDEV_NUM];
  70
  71 static int ifpga_monitor_start;
  72 static pthread_t ifpga_monitor_start_thread;
  73
  74 #define IFPGA_MAX_IRQ 12
  75 /* 0 for FME interrupt, others are reserved for AFU irq */
  76 static struct rte_intr_handle ifpga_irq_handle[IFPGA_MAX_IRQ];
  77
  78 static struct ifpga_rawdev *
  79 ifpga_rawdev_allocate(struct rte_rawdev *rawdev);
  80 static int set_surprise_link_check_aer(
  81                 struct ifpga_rawdev *ifpga_rdev, int force_disable);
  82 static int ifpga_pci_find_next_ext_capability(unsigned int fd,
  83                                               int start, uint32_t cap);
  84 static int ifpga_pci_find_ext_capability(unsigned int fd, uint32_t cap);
  85
  86 struct ifpga_rawdev *
  87 ifpga_rawdev_get(const struct rte_rawdev *rawdev)
  88 {
  89         struct ifpga_rawdev *dev;
  90         unsigned int i;
  91
  92         if (rawdev == NULL)
  93                 return NULL;
  94
  95         for (i = 0; i < IFPGA_RAWDEV_NUM; i++) {
  96                 dev = &ifpga_rawdevices[i];
  97                 if (dev->rawdev == rawdev)
  98                         return dev;
  99         }
 100
 101         return NULL;
 102 }
 103
 104 static inline uint8_t
 105 ifpga_rawdev_find_free_device_index(void)
 106 {
 107         uint16_t dev_id;
 108
 109         for (dev_id = 0; dev_id < IFPGA_RAWDEV_NUM; dev_id++) {
 110                 if (ifpga_rawdevices[dev_id].rawdev == NULL)
 111                         return dev_id;
 112         }
 113
 114         return IFPGA_RAWDEV_NUM;
 115 }
 116 static struct ifpga_rawdev *
 117 ifpga_rawdev_allocate(struct rte_rawdev *rawdev)
 118 {
 119         struct ifpga_rawdev *dev;
 120         uint16_t dev_id;
 121
 122         dev = ifpga_rawdev_get(rawdev);
 123         if (dev != NULL) {
 124                 IFPGA_RAWDEV_PMD_ERR("Event device already allocated!");
 125                 return NULL;
 126         }
 127
 128         dev_id = ifpga_rawdev_find_free_device_index();
 129         if (dev_id == IFPGA_RAWDEV_NUM) {
 130                 IFPGA_RAWDEV_PMD_ERR("Reached maximum number of raw devices");
 131                 return NULL;
 132         }
 133
 134         dev = &ifpga_rawdevices[dev_id];
 135         dev->rawdev = rawdev;
 136         dev->dev_id = dev_id;
 137
 138         return dev;
 139 }
 140
 141 static int
 142 ifpga_pci_find_next_ext_capability(unsigned int fd, int start, uint32_t cap)
 143 {
 144         uint32_t header;
 145         int ttl;
 146         int pos = RTE_PCI_CFG_SPACE_SIZE;
 147         int ret;
 148
 149         /* minimum 8 bytes per capability */
 150         ttl = (RTE_PCI_CFG_SPACE_EXP_SIZE - RTE_PCI_CFG_SPACE_SIZE) / 8;
 151
 152         if (start)
 153                 pos = start;
 154         ret = pread(fd, &header, sizeof(header), pos);
 155         if (ret == -1)
 156                 return -1;
 157
 158         /*
 159          * If we have no capabilities, this is indicated by cap ID,
 160          * cap version and next pointer all being 0.
 161          */
 162         if (header == 0)
 163                 return 0;
 164
 165         while (ttl-- > 0) {
 166                 if (RTE_PCI_EXT_CAP_ID(header) == cap && pos != start)
 167                         return pos;
 168
 169                 pos = RTE_PCI_EXT_CAP_NEXT(header);
 170                 if (pos < RTE_PCI_CFG_SPACE_SIZE)
 171                         break;
 172                 ret = pread(fd, &header, sizeof(header), pos);
 173                 if (ret == -1)
 174                         return -1;
 175         }
 176
 177         return 0;
 178 }
 179
 180 static int
 181 ifpga_pci_find_ext_capability(unsigned int fd, uint32_t cap)
 182 {
 183         return ifpga_pci_find_next_ext_capability(fd, 0, cap);
 184 }
 185
 186 static int ifpga_get_dev_vendor_id(const char *bdf,
 187         uint32_t *dev_id, uint32_t *vendor_id)
 188 {
 189         int fd;
 190         char path[1024];
 191         int ret;
 192         uint32_t header;
 193
 194         strlcpy(path, "/sys/bus/pci/devices/", sizeof(path));
 195         strlcat(path, bdf, sizeof(path));
 196         strlcat(path, "/config", sizeof(path));
 197         fd = open(path, O_RDWR);
 198         if (fd < 0)
 199                 return -1;
 200         ret = pread(fd, &header, sizeof(header), 0);
 201         if (ret == -1) {
 202                 close(fd);
 203                 return -1;
 204         }
 205         (*vendor_id) = header & 0xffff;
 206         (*dev_id) = (header >> 16) & 0xffff;
 207         close(fd);
 208
 209         return 0;
 210 }
 211 static int ifpga_rawdev_fill_info(struct ifpga_rawdev *ifpga_dev,
 212         const char *bdf)
 213 {
 214         char path[1024] = "/sys/bus/pci/devices/0000:";
 215         char link[1024], link1[1024];
 216         char dir[1024] = "/sys/devices/";
 217         char *c;
 218         int ret;
 219         char sub_brg_bdf[4][16];
 220         int point;
 221         DIR *dp = NULL;
 222         struct dirent *entry;
 223         int i, j;
 224
 225         unsigned int dom, bus, dev;
 226         int func;
 227         uint32_t dev_id, vendor_id;
 228
 229         strlcat(path, bdf, sizeof(path));
 230         memset(link, 0, sizeof(link));
 231         memset(link1, 0, sizeof(link1));
 232         ret = readlink(path, link, (sizeof(link)-1));
 233         if ((ret < 0) || ((unsigned int)ret > (sizeof(link)-1)))
 234                 return -1;
 235         link[ret] = 0;   /* terminate string with null character */
 236         strlcpy(link1, link, sizeof(link1));
 237         memset(ifpga_dev->parent_bdf, 0, 16);
 238         point = strlen(link);
 239         if (point < 39)
 240                 return -1;
 241         point -= 39;
 242         link[point] = 0;
 243         if (point < 12)
 244                 return -1;
 245         point -= 12;
 246         rte_memcpy(ifpga_dev->parent_bdf, &link[point], 12);
 247
 248         point = strlen(link1);
 249         if (point < 26)
 250                 return -1;
 251         point -= 26;
 252         link1[point] = 0;
 253         if (point < 12)
 254                 return -1;
 255         point -= 12;
 256         c = strchr(link1, 'p');
 257         if (!c)
 258                 return -1;
 259         strlcat(dir, c, sizeof(dir));
 260
 261         /* scan folder */
 262         dp = opendir(dir);
 263         if (dp == NULL)
 264                 return -1;
 265         i = 0;
 266         while ((entry = readdir(dp)) != NULL) {
 267                 if (i >= 4)
 268                         break;
 269                 if (entry->d_name[0] == '.')
 270                         continue;
 271                 if (strlen(entry->d_name) > 12)
 272                         continue;
 273                 if (sscanf(entry->d_name, "%x:%x:%x.%d",
 274                         &dom, &bus, &dev, &func) < 4)
 275                         continue;
 276                 else {
 277                         strlcpy(sub_brg_bdf[i],
 278                                 entry->d_name,
 279                                 sizeof(sub_brg_bdf[i]));
 280                         i++;
 281                 }
 282         }
 283         closedir(dp);
 284
 285         /* get fpga and fvl */
 286         j = 0;
 287         for (i = 0; i < 4; i++) {
 288                 strlcpy(link, dir, sizeof(link));
 289                 strlcat(link, "/", sizeof(link));
 290                 strlcat(link, sub_brg_bdf[i], sizeof(link));
 291                 dp = opendir(link);
 292                 if (dp == NULL)
 293                         return -1;
 294                 while ((entry = readdir(dp)) != NULL) {
 295                         if (j >= 8)
 296                                 break;
 297                         if (entry->d_name[0] == '.')
 298                                 continue;
 299
 300                         if (strlen(entry->d_name) > 12)
 301                                 continue;
 302                         if (sscanf(entry->d_name, "%x:%x:%x.%d",
 303                                 &dom, &bus, &dev, &func) < 4)
 304                                 continue;
 305                         else {
 306                                 if (ifpga_get_dev_vendor_id(entry->d_name,
 307                                         &dev_id, &vendor_id))
 308                                         continue;
 309                                 if (vendor_id == 0x8086 &&
 310                                         (dev_id == 0x0CF8 ||
 311                                         dev_id == 0x0D58 ||
 312                                         dev_id == 0x1580)) {
 313                                         strlcpy(ifpga_dev->fvl_bdf[j],
 314                                                 entry->d_name,
 315                                                 sizeof(ifpga_dev->fvl_bdf[j]));
 316                                         j++;
 317                                 }
 318                         }
 319                 }
 320                 closedir(dp);
 321         }
 322
 323         return 0;
 324 }
 325
 326 #define HIGH_FATAL(_sens, value)\
 327         (((_sens)->flags & OPAE_SENSOR_HIGH_FATAL_VALID) &&\
 328          (value > (_sens)->high_fatal))
 329
 330 #define HIGH_WARN(_sens, value)\
 331         (((_sens)->flags & OPAE_SENSOR_HIGH_WARN_VALID) &&\
 332          (value > (_sens)->high_warn))
 333
 334 #define LOW_FATAL(_sens, value)\
 335         (((_sens)->flags & OPAE_SENSOR_LOW_FATAL_VALID) &&\
 336          (value > (_sens)->low_fatal))
 337
 338 #define LOW_WARN(_sens, value)\
 339         (((_sens)->flags & OPAE_SENSOR_LOW_WARN_VALID) &&\
 340          (value > (_sens)->low_warn))
 341
 342 #define AUX_VOLTAGE_WARN 11400
 343
 344 static int
 345 ifpga_monitor_sensor(struct rte_rawdev *raw_dev,
 346                bool *gsd_start)
 347 {
 348         struct opae_adapter *adapter;
 349         struct opae_manager *mgr;
 350         struct opae_sensor_info *sensor;
 351         unsigned int value;
 352         int ret;
 353
 354         adapter = ifpga_rawdev_get_priv(raw_dev);
 355         if (!adapter)
 356                 return -ENODEV;
 357
 358         mgr = opae_adapter_get_mgr(adapter);
 359         if (!mgr)
 360                 return -ENODEV;
 361
 362         opae_mgr_for_each_sensor(mgr, sensor) {
 363                 if (!(sensor->flags & OPAE_SENSOR_VALID))
 364                         goto fail;
 365
 366                 ret = opae_mgr_get_sensor_value(mgr, sensor, &value);
 367                 if (ret)
 368                         goto fail;
 369
 370                 if (value == 0xdeadbeef) {
 371                         IFPGA_RAWDEV_PMD_ERR("dev_id %d sensor %s value %x\n",
 372                                         raw_dev->dev_id, sensor->name, value);
 373                         continue;
 374                 }
 375
 376                 /* monitor temperature sensors */
 377                 if (!strcmp(sensor->name, "Board Temperature") ||
 378                                 !strcmp(sensor->name, "FPGA Die Temperature")) {
 379                         IFPGA_RAWDEV_PMD_INFO("read sensor %s %d %d %d\n",
 380                                         sensor->name, value, sensor->high_warn,
 381                                         sensor->high_fatal);
 382
 383                         if (HIGH_WARN(sensor, value) ||
 384                                 LOW_WARN(sensor, value)) {
 385                                 IFPGA_RAWDEV_PMD_INFO("%s reach theshold %d\n",
 386                                         sensor->name, value);
 387                                 *gsd_start = true;
 388                                 break;
 389                         }
 390                 }
 391
 392                 /* monitor 12V AUX sensor */
 393                 if (!strcmp(sensor->name, "12V AUX Voltage")) {
 394                         if (value < AUX_VOLTAGE_WARN) {
 395                                 IFPGA_RAWDEV_PMD_INFO(
 396                                         "%s reach theshold %d mV\n",
 397                                         sensor->name, value);
 398                                 *gsd_start = true;
 399                                 break;
 400                         }
 401                 }
 402         }
 403
 404         return 0;
 405 fail:
 406         return -EFAULT;
 407 }
 408
 409 static int set_surprise_link_check_aer(
 410         struct ifpga_rawdev *ifpga_rdev, int force_disable)
 411 {
 412         struct rte_rawdev *rdev;
 413         int fd = -1;
 414         char path[1024];
 415         int pos;
 416         int ret;
 417         uint32_t data;
 418         bool enable = 0;
 419         uint32_t aer_new0, aer_new1;
 420
 421         if (!ifpga_rdev) {
 422                 printf("\n device does not exist\n");
 423                 return -EFAULT;
 424         }
 425
 426         rdev = ifpga_rdev->rawdev;
 427         if (ifpga_rdev->aer_enable)
 428                 return -EFAULT;
 429         if (ifpga_monitor_sensor(rdev, &enable))
 430                 return -EFAULT;
 431         if (enable || force_disable) {
 432                 IFPGA_RAWDEV_PMD_ERR("Set AER, pls graceful shutdown\n");
 433                 ifpga_rdev->aer_enable = 1;
 434                 /* get bridge fd */
 435                 strlcpy(path, "/sys/bus/pci/devices/", sizeof(path));
 436                 strlcat(path, ifpga_rdev->parent_bdf, sizeof(path));
 437                 strlcat(path, "/config", sizeof(path));
 438                 fd = open(path, O_RDWR);
 439                 if (fd < 0)
 440                         goto end;
 441                 pos = ifpga_pci_find_ext_capability(fd, RTE_PCI_EXT_CAP_ID_ERR);
 442                 if (!pos)
 443                         goto end;
 444                 /* save previout ECAP_AER+0x08 */
 445                 ret = pread(fd, &data, sizeof(data), pos+0x08);
 446                 if (ret == -1)
 447                         goto end;
 448                 ifpga_rdev->aer_old[0] = data;
 449                 /* save previout ECAP_AER+0x14 */
 450                 ret = pread(fd, &data, sizeof(data), pos+0x14);
 451                 if (ret == -1)
 452                         goto end;
 453                 ifpga_rdev->aer_old[1] = data;
 454
 455                 /* set ECAP_AER+0x08 to 0xFFFFFFFF */
 456                 data = 0xffffffff;
 457                 ret = pwrite(fd, &data, 4, pos+0x08);
 458                 if (ret == -1)
 459                         goto end;
 460                 /* set ECAP_AER+0x14 to 0xFFFFFFFF */
 461                 ret = pwrite(fd, &data, 4, pos+0x14);
 462                 if (ret == -1)
 463                         goto end;
 464
 465                 /* read current ECAP_AER+0x08 */
 466                 ret = pread(fd, &data, sizeof(data), pos+0x08);
 467                 if (ret == -1)
 468                         goto end;
 469                 aer_new0 = data;
 470                 /* read current ECAP_AER+0x14 */
 471                 ret = pread(fd, &data, sizeof(data), pos+0x14);
 472                 if (ret == -1)
 473                         goto end;
 474                 aer_new1 = data;
 475
 476                 if (fd != -1)
 477                         close(fd);
 478
 479                 printf(">>>>>>Set AER %x,%x %x,%x\n",
 480                         ifpga_rdev->aer_old[0], ifpga_rdev->aer_old[1],
 481                         aer_new0, aer_new1);
 482
 483                 return 1;
 484                 }
 485
 486 end:
 487         if (fd != -1)
 488                 close(fd);
 489         return -EFAULT;
 490 }
 491
 492 static void *
 493 ifpga_rawdev_gsd_handle(__rte_unused void *param)
 494 {
 495         struct ifpga_rawdev *ifpga_rdev;
 496         int i;
 497         int gsd_enable, ret;
 498 #define MS 1000
 499
 500         while (1) {
 501                 gsd_enable = 0;
 502                 for (i = 0; i < IFPGA_RAWDEV_NUM; i++) {
 503                         ifpga_rdev = &ifpga_rawdevices[i];
 504                         if (ifpga_rdev->rawdev) {
 505                                 ret = set_surprise_link_check_aer(ifpga_rdev,
 506                                         gsd_enable);
 507                                 if (ret == 1 && !gsd_enable) {
 508                                         gsd_enable = 1;
 509                                         i = -1;
 510                                 }
 511                         }
 512                 }
 513
 514                 if (gsd_enable)
 515                         printf(">>>>>>Pls Shutdown APP\n");
 516
 517                 rte_delay_us(100 * MS);
 518         }
 519
 520         return NULL;
 521 }
 522
 523 static int
 524 ifpga_monitor_start_func(void)
 525 {
 526         int ret;
 527
 528         if (ifpga_monitor_start == 0) {
 529                 ret = pthread_create(&ifpga_monitor_start_thread,
 530                         NULL,
 531                         ifpga_rawdev_gsd_handle, NULL);
 532                 if (ret) {
 533                         IFPGA_RAWDEV_PMD_ERR(
 534                                 "Fail to create ifpga nonitor thread");
 535                         return -1;
 536                 }
 537                 ifpga_monitor_start = 1;
 538         }
 539
 540         return 0;
 541 }
 542 static int
 543 ifpga_monitor_stop_func(void)
 544 {
 545         int ret;
 546
 547         if (ifpga_monitor_start == 1) {
 548                 ret = pthread_cancel(ifpga_monitor_start_thread);
 549                 if (ret)
 550                         IFPGA_RAWDEV_PMD_ERR("Can't cancel the thread");
 551
 552                 ret = pthread_join(ifpga_monitor_start_thread, NULL);
 553                 if (ret)
 554                         IFPGA_RAWDEV_PMD_ERR("Can't join the thread");
 555
 556                 ifpga_monitor_start = 0;
 557
 558                 return ret;
 559         }
 560
 561         return 0;
 562 }
 563
 564 static int
 565 ifpga_fill_afu_dev(struct opae_accelerator *acc,
 566                 struct rte_afu_device *afu_dev)
 567 {
 568         struct rte_mem_resource *res = afu_dev->mem_resource;
 569         struct opae_acc_region_info region_info;
 570         struct opae_acc_info info;
 571         unsigned long i;
 572         int ret;
 573
 574         ret = opae_acc_get_info(acc, &info);
 575         if (ret)
 576                 return ret;
 577
 578         if (info.num_regions > PCI_MAX_RESOURCE)
 579                 return -EFAULT;
 580
 581         afu_dev->num_region = info.num_regions;
 582
 583         for (i = 0; i < info.num_regions; i++) {
 584                 region_info.index = i;
 585                 ret = opae_acc_get_region_info(acc, &region_info);
 586                 if (ret)
 587                         return ret;
 588
 589                 if ((region_info.flags & ACC_REGION_MMIO) &&
 590                     (region_info.flags & ACC_REGION_READ) &&
 591                     (region_info.flags & ACC_REGION_WRITE)) {
 592                         res[i].phys_addr = region_info.phys_addr;
 593                         res[i].len = region_info.len;
 594                         res[i].addr = region_info.addr;
 595                 } else
 596                         return -EFAULT;
 597         }
 598
 599         return 0;
 600 }
 601
 602 static int
 603 ifpga_rawdev_info_get(struct rte_rawdev *dev,
 604                       rte_rawdev_obj_t dev_info,
 605                       size_t dev_info_size)
 606 {
 607         struct opae_adapter *adapter;
 608         struct opae_accelerator *acc;
 609         struct rte_afu_device *afu_dev;
 610         struct opae_manager *mgr = NULL;
 611         struct opae_eth_group_region_info opae_lside_eth_info;
 612         struct opae_eth_group_region_info opae_nside_eth_info;
 613         int lside_bar_idx, nside_bar_idx;
 614
 615         IFPGA_RAWDEV_PMD_FUNC_TRACE();
 616
 617         if (!dev_info || dev_info_size != sizeof(*afu_dev)) {
 618                 IFPGA_RAWDEV_PMD_ERR("Invalid request");
 619                 return -EINVAL;
 620         }
 621
 622         adapter = ifpga_rawdev_get_priv(dev);
 623         if (!adapter)
 624                 return -ENOENT;
 625
 626         afu_dev = dev_info;
 627         afu_dev->rawdev = dev;
 628
 629         /* find opae_accelerator and fill info into afu_device */
 630         opae_adapter_for_each_acc(adapter, acc) {
 631                 if (acc->index != afu_dev->id.port)
 632                         continue;
 633
 634                 if (ifpga_fill_afu_dev(acc, afu_dev)) {
 635                         IFPGA_RAWDEV_PMD_ERR("cannot get info\n");
 636                         return -ENOENT;
 637                 }
 638         }
 639
 640         /* get opae_manager to rawdev */
 641         mgr = opae_adapter_get_mgr(adapter);
 642         if (mgr) {
 643                 /* get LineSide BAR Index */
 644                 if (opae_manager_get_eth_group_region_info(mgr, 0,
 645                         &opae_lside_eth_info)) {
 646                         return -ENOENT;
 647                 }
 648                 lside_bar_idx = opae_lside_eth_info.mem_idx;
 649
 650                 /* get NICSide BAR Index */
 651                 if (opae_manager_get_eth_group_region_info(mgr, 1,
 652                         &opae_nside_eth_info)) {
 653                         return -ENOENT;
 654                 }
 655                 nside_bar_idx = opae_nside_eth_info.mem_idx;
 656
 657                 if (lside_bar_idx >= PCI_MAX_RESOURCE ||
 658                         nside_bar_idx >= PCI_MAX_RESOURCE ||
 659                         lside_bar_idx == nside_bar_idx)
 660                         return -ENOENT;
 661
 662                 /* fill LineSide BAR Index */
 663                 afu_dev->mem_resource[lside_bar_idx].phys_addr =
 664                         opae_lside_eth_info.phys_addr;
 665                 afu_dev->mem_resource[lside_bar_idx].len =
 666                         opae_lside_eth_info.len;
 667                 afu_dev->mem_resource[lside_bar_idx].addr =
 668                         opae_lside_eth_info.addr;
 669
 670                 /* fill NICSide BAR Index */
 671                 afu_dev->mem_resource[nside_bar_idx].phys_addr =
 672                         opae_nside_eth_info.phys_addr;
 673                 afu_dev->mem_resource[nside_bar_idx].len =
 674                         opae_nside_eth_info.len;
 675                 afu_dev->mem_resource[nside_bar_idx].addr =
 676                         opae_nside_eth_info.addr;
 677         }
 678         return 0;
 679 }
 680
 681 static int
 682 ifpga_rawdev_configure(const struct rte_rawdev *dev,
 683                 rte_rawdev_obj_t config,
 684                 size_t config_size __rte_unused)
 685 {
 686         IFPGA_RAWDEV_PMD_FUNC_TRACE();
 687
 688         RTE_FUNC_PTR_OR_ERR_RET(dev, -EINVAL);
 689
 690         return config ? 0 : 1;
 691 }
 692
 693 static int
 694 ifpga_rawdev_start(struct rte_rawdev *dev)
 695 {
 696         int ret = 0;
 697         struct opae_adapter *adapter;
 698
 699         IFPGA_RAWDEV_PMD_FUNC_TRACE();
 700
 701         RTE_FUNC_PTR_OR_ERR_RET(dev, -EINVAL);
 702
 703         adapter = ifpga_rawdev_get_priv(dev);
 704         if (!adapter)
 705                 return -ENODEV;
 706
 707         return ret;
 708 }
 709
 710 static void
 711 ifpga_rawdev_stop(struct rte_rawdev *dev)
 712 {
 713         dev->started = 0;
 714 }
 715
 716 static int
 717 ifpga_rawdev_close(struct rte_rawdev *dev)
 718 {
 719         struct opae_adapter *adapter;
 720
 721         if (dev) {
 722                 adapter = ifpga_rawdev_get_priv(dev);
 723                 if (adapter) {
 724                         opae_adapter_destroy(adapter);
 725                         opae_adapter_data_free(adapter->data);
 726                 }
 727         }
 728
 729         return dev ? 0:1;
 730 }
 731
 732 static int
 733 ifpga_rawdev_reset(struct rte_rawdev *dev)
 734 {
 735         return dev ? 0:1;
 736 }
 737
 738 static int
 739 fpga_pr(struct rte_rawdev *raw_dev, u32 port_id, const char *buffer, u32 size,
 740                         u64 *status)
 741 {
 742
 743         struct opae_adapter *adapter;
 744         struct opae_manager *mgr;
 745         struct opae_accelerator *acc;
 746         struct opae_bridge *br;
 747         int ret;
 748
 749         adapter = ifpga_rawdev_get_priv(raw_dev);
 750         if (!adapter)
 751                 return -ENODEV;
 752
 753         mgr = opae_adapter_get_mgr(adapter);
 754         if (!mgr)
 755                 return -ENODEV;
 756
 757         acc = opae_adapter_get_acc(adapter, port_id);
 758         if (!acc)
 759                 return -ENODEV;
 760
 761         br = opae_acc_get_br(acc);
 762         if (!br)
 763                 return -ENODEV;
 764
 765         ret = opae_manager_flash(mgr, port_id, buffer, size, status);
 766         if (ret) {
 767                 IFPGA_RAWDEV_PMD_ERR("%s pr error %d\n", __func__, ret);
 768                 return ret;
 769         }
 770
 771         ret = opae_bridge_reset(br);
 772         if (ret) {
 773                 IFPGA_RAWDEV_PMD_ERR("%s reset port:%d error %d\n",
 774                                 __func__, port_id, ret);
 775                 return ret;
 776         }
 777
 778         return ret;
 779 }
 780
 781 static int
 782 rte_fpga_do_pr(struct rte_rawdev *rawdev, int port_id,
 783                 const char *file_name)
 784 {
 785         struct stat file_stat;
 786         int file_fd;
 787         int ret = 0;
 788         ssize_t buffer_size;
 789         void *buffer;
 790         u64 pr_error;
 791
 792         if (!file_name)
 793                 return -EINVAL;
 794
 795         file_fd = open(file_name, O_RDONLY);
 796         if (file_fd < 0) {
 797                 IFPGA_RAWDEV_PMD_ERR("%s: open file error: %s\n",
 798                                 __func__, file_name);
 799                 IFPGA_RAWDEV_PMD_ERR("Message : %s\n", strerror(errno));
 800                 return -EINVAL;
 801         }
 802         ret = stat(file_name, &file_stat);
 803         if (ret) {
 804                 IFPGA_RAWDEV_PMD_ERR("stat on bitstream file failed: %s\n",
 805                                 file_name);
 806                 ret = -EINVAL;
 807                 goto close_fd;
 808         }
 809         buffer_size = file_stat.st_size;
 810         if (buffer_size <= 0) {
 811                 ret = -EINVAL;
 812                 goto close_fd;
 813         }
 814
 815         IFPGA_RAWDEV_PMD_INFO("bitstream file size: %zu\n", buffer_size);
 816         buffer = rte_malloc(NULL, buffer_size, 0);
 817         if (!buffer) {
 818                 ret = -ENOMEM;
 819                 goto close_fd;
 820         }
 821
 822         /*read the raw data*/
 823         if (buffer_size != read(file_fd, (void *)buffer, buffer_size)) {
 824                 ret = -EINVAL;
 825                 goto free_buffer;
 826         }
 827
 828         /*do PR now*/
 829         ret = fpga_pr(rawdev, port_id, buffer, buffer_size, &pr_error);
 830         IFPGA_RAWDEV_PMD_INFO("downloading to device port %d....%s.\n", port_id,
 831                 ret ? "failed" : "success");
 832         if (ret) {
 833                 ret = -EINVAL;
 834                 goto free_buffer;
 835         }
 836
 837 free_buffer:
 838         if (buffer)
 839                 rte_free(buffer);
 840 close_fd:
 841         close(file_fd);
 842         file_fd = 0;
 843         return ret;
 844 }
 845
 846 static int
 847 ifpga_rawdev_pr(struct rte_rawdev *dev,
 848         rte_rawdev_obj_t pr_conf)
 849 {
 850         struct opae_adapter *adapter;
 851         struct opae_manager *mgr;
 852         struct opae_board_info *info;
 853         struct rte_afu_pr_conf *afu_pr_conf;
 854         int ret;
 855         struct uuid uuid;
 856         struct opae_accelerator *acc;
 857
 858         IFPGA_RAWDEV_PMD_FUNC_TRACE();
 859
 860         adapter = ifpga_rawdev_get_priv(dev);
 861         if (!adapter)
 862                 return -ENODEV;
 863
 864         if (!pr_conf)
 865                 return -EINVAL;
 866
 867         afu_pr_conf = pr_conf;
 868
 869         if (afu_pr_conf->pr_enable) {
 870                 ret = rte_fpga_do_pr(dev,
 871                                 afu_pr_conf->afu_id.port,
 872                                 afu_pr_conf->bs_path);
 873                 if (ret) {
 874                         IFPGA_RAWDEV_PMD_ERR("do pr error %d\n", ret);
 875                         return ret;
 876                 }
 877         }
 878
 879         mgr = opae_adapter_get_mgr(adapter);
 880         if (!mgr) {
 881                 IFPGA_RAWDEV_PMD_ERR("opae_manager of opae_adapter is NULL");
 882                 return -1;
 883         }
 884
 885         if (ifpga_mgr_ops.get_board_info(mgr, &info)) {
 886                 IFPGA_RAWDEV_PMD_ERR("ifpga manager get_board_info fail!");
 887                 return -1;
 888         }
 889
 890         if (info->lightweight) {
 891                 /* set uuid to all 0, when fpga is lightweight image */
 892                 memset(&afu_pr_conf->afu_id.uuid.uuid_low, 0, sizeof(u64));
 893                 memset(&afu_pr_conf->afu_id.uuid.uuid_high, 0, sizeof(u64));
 894         } else {
 895                 acc = opae_adapter_get_acc(adapter, afu_pr_conf->afu_id.port);
 896                 if (!acc)
 897                         return -ENODEV;
 898
 899                 ret = opae_acc_get_uuid(acc, &uuid);
 900                 if (ret)
 901                         return ret;
 902
 903                 rte_memcpy(&afu_pr_conf->afu_id.uuid.uuid_low, uuid.b,
 904                         sizeof(u64));
 905                 rte_memcpy(&afu_pr_conf->afu_id.uuid.uuid_high, uuid.b + 8,
 906                         sizeof(u64));
 907
 908                 IFPGA_RAWDEV_PMD_INFO("%s: uuid_l=0x%lx, uuid_h=0x%lx\n",
 909                         __func__,
 910                         (unsigned long)afu_pr_conf->afu_id.uuid.uuid_low,
 911                         (unsigned long)afu_pr_conf->afu_id.uuid.uuid_high);
 912                 }
 913         return 0;
 914 }
 915
 916 static int
 917 ifpga_rawdev_get_attr(struct rte_rawdev *dev,
 918         const char *attr_name, uint64_t *attr_value)
 919 {
 920         struct opae_adapter *adapter;
 921         struct opae_manager *mgr;
 922         struct opae_retimer_info opae_rtm_info;
 923         struct opae_retimer_status opae_rtm_status;
 924         struct opae_eth_group_info opae_eth_grp_info;
 925         struct opae_eth_group_region_info opae_eth_grp_reg_info;
 926         int eth_group_num = 0;
 927         uint64_t port_link_bitmap = 0, port_link_bit;
 928         uint32_t i, j, p, q;
 929
 930 #define MAX_PORT_PER_RETIMER    4
 931
 932         IFPGA_RAWDEV_PMD_FUNC_TRACE();
 933
 934         if (!dev || !attr_name || !attr_value) {
 935                 IFPGA_RAWDEV_PMD_ERR("Invalid arguments for getting attributes");
 936                 return -1;
 937         }
 938
 939         adapter = ifpga_rawdev_get_priv(dev);
 940         if (!adapter) {
 941                 IFPGA_RAWDEV_PMD_ERR("Adapter of dev %s is NULL", dev->name);
 942                 return -1;
 943         }
 944
 945         mgr = opae_adapter_get_mgr(adapter);
 946         if (!mgr) {
 947                 IFPGA_RAWDEV_PMD_ERR("opae_manager of opae_adapter is NULL");
 948                 return -1;
 949         }
 950
 951         /* currently, eth_group_num is always 2 */
 952         eth_group_num = opae_manager_get_eth_group_nums(mgr);
 953         if (eth_group_num < 0)
 954                 return -1;
 955
 956         if (!strcmp(attr_name, "LineSideBaseMAC")) {
 957                 /* Currently FPGA not implement, so just set all zeros*/
 958                 *attr_value = (uint64_t)0;
 959                 return 0;
 960         }
 961         if (!strcmp(attr_name, "LineSideMACType")) {
 962                 /* eth_group 0 on FPGA connect to LineSide */
 963                 if (opae_manager_get_eth_group_info(mgr, 0,
 964                         &opae_eth_grp_info))
 965                         return -1;
 966                 switch (opae_eth_grp_info.speed) {
 967                 case ETH_SPEED_10G:
 968                         *attr_value =
 969                         (uint64_t)(IFPGA_RAWDEV_RETIMER_MAC_TYPE_10GE_XFI);
 970                         break;
 971                 case ETH_SPEED_25G:
 972                         *attr_value =
 973                         (uint64_t)(IFPGA_RAWDEV_RETIMER_MAC_TYPE_25GE_25GAUI);
 974                         break;
 975                 default:
 976                         *attr_value =
 977                         (uint64_t)(IFPGA_RAWDEV_RETIMER_MAC_TYPE_UNKNOWN);
 978                         break;
 979                 }
 980                 return 0;
 981         }
 982         if (!strcmp(attr_name, "LineSideLinkSpeed")) {
 983                 if (opae_manager_get_retimer_status(mgr, &opae_rtm_status))
 984                         return -1;
 985                 switch (opae_rtm_status.speed) {
 986                 case MXD_1GB:
 987                         *attr_value =
 988                                 (uint64_t)(IFPGA_RAWDEV_LINK_SPEED_UNKNOWN);
 989                         break;
 990                 case MXD_2_5GB:
 991                         *attr_value =
 992                                 (uint64_t)(IFPGA_RAWDEV_LINK_SPEED_UNKNOWN);
 993                         break;
 994                 case MXD_5GB:
 995                         *attr_value =
 996                                 (uint64_t)(IFPGA_RAWDEV_LINK_SPEED_UNKNOWN);
 997                         break;
 998                 case MXD_10GB:
 999                         *attr_value =
1000                                 (uint64_t)(IFPGA_RAWDEV_LINK_SPEED_10GB);
1001                         break;
1002                 case MXD_25GB:
1003                         *attr_value =
1004                                 (uint64_t)(IFPGA_RAWDEV_LINK_SPEED_25GB);
1005                         break;
1006                 case MXD_40GB:
1007                         *attr_value =
1008                                 (uint64_t)(IFPGA_RAWDEV_LINK_SPEED_40GB);
1009                         break;
1010                 case MXD_100GB:
1011                         *attr_value =
1012                                 (uint64_t)(IFPGA_RAWDEV_LINK_SPEED_UNKNOWN);
1013                         break;
1014                 case MXD_SPEED_UNKNOWN:
1015                         *attr_value =
1016                                 (uint64_t)(IFPGA_RAWDEV_LINK_SPEED_UNKNOWN);
1017                         break;
1018                 default:
1019                         *attr_value =
1020                                 (uint64_t)(IFPGA_RAWDEV_LINK_SPEED_UNKNOWN);
1021                         break;
1022                 }
1023                 return 0;
1024         }
1025         if (!strcmp(attr_name, "LineSideLinkRetimerNum")) {
1026                 if (opae_manager_get_retimer_info(mgr, &opae_rtm_info))
1027                         return -1;
1028                 *attr_value = (uint64_t)(opae_rtm_info.nums_retimer);
1029                 return 0;
1030         }
1031         if (!strcmp(attr_name, "LineSideLinkPortNum")) {
1032                 if (opae_manager_get_retimer_info(mgr, &opae_rtm_info))
1033                         return -1;
1034                 uint64_t tmp = (uint64_t)opae_rtm_info.ports_per_retimer *
1035                                         (uint64_t)opae_rtm_info.nums_retimer;
1036                 *attr_value = tmp;
1037                 return 0;
1038         }
1039         if (!strcmp(attr_name, "LineSideLinkStatus")) {
1040                 if (opae_manager_get_retimer_info(mgr, &opae_rtm_info))
1041                         return -1;
1042                 if (opae_manager_get_retimer_status(mgr, &opae_rtm_status))
1043                         return -1;
1044                 (*attr_value) = 0;
1045                 q = 0;
1046                 port_link_bitmap = (uint64_t)(opae_rtm_status.line_link_bitmap);
1047                 for (i = 0; i < opae_rtm_info.nums_retimer; i++) {
1048                         p = i * MAX_PORT_PER_RETIMER;
1049                         for (j = 0; j < opae_rtm_info.ports_per_retimer; j++) {
1050                                 port_link_bit = 0;
1051                                 IFPGA_BIT_SET(port_link_bit, (p+j));
1052                                 port_link_bit &= port_link_bitmap;
1053                                 if (port_link_bit)
1054                                         IFPGA_BIT_SET((*attr_value), q);
1055                                 q++;
1056                         }
1057                 }
1058                 return 0;
1059         }
1060         if (!strcmp(attr_name, "LineSideBARIndex")) {
1061                 /* eth_group 0 on FPGA connect to LineSide */
1062                 if (opae_manager_get_eth_group_region_info(mgr, 0,
1063                         &opae_eth_grp_reg_info))
1064                         return -1;
1065                 *attr_value = (uint64_t)opae_eth_grp_reg_info.mem_idx;
1066                 return 0;
1067         }
1068         if (!strcmp(attr_name, "NICSideMACType")) {
1069                 /* eth_group 1 on FPGA connect to NicSide */
1070                 if (opae_manager_get_eth_group_info(mgr, 1,
1071                         &opae_eth_grp_info))
1072                         return -1;
1073                 *attr_value = (uint64_t)(opae_eth_grp_info.speed);
1074                 return 0;
1075         }
1076         if (!strcmp(attr_name, "NICSideLinkSpeed")) {
1077                 /* eth_group 1 on FPGA connect to NicSide */
1078                 if (opae_manager_get_eth_group_info(mgr, 1,
1079                         &opae_eth_grp_info))
1080                         return -1;
1081                 *attr_value = (uint64_t)(opae_eth_grp_info.speed);
1082                 return 0;
1083         }
1084         if (!strcmp(attr_name, "NICSideLinkPortNum")) {
1085                 if (opae_manager_get_retimer_info(mgr, &opae_rtm_info))
1086                         return -1;
1087                 uint64_t tmp = (uint64_t)opae_rtm_info.nums_fvl *
1088                                         (uint64_t)opae_rtm_info.ports_per_fvl;
1089                 *attr_value = tmp;
1090                 return 0;
1091         }
1092         if (!strcmp(attr_name, "NICSideLinkStatus"))
1093                 return 0;
1094         if (!strcmp(attr_name, "NICSideBARIndex")) {
1095                 /* eth_group 1 on FPGA connect to NicSide */
1096                 if (opae_manager_get_eth_group_region_info(mgr, 1,
1097                         &opae_eth_grp_reg_info))
1098                         return -1;
1099                 *attr_value = (uint64_t)opae_eth_grp_reg_info.mem_idx;
1100                 return 0;
1101         }
1102
1103         IFPGA_RAWDEV_PMD_ERR("%s not support", attr_name);
1104         return -1;
1105 }
1106
1107 static const struct rte_rawdev_ops ifpga_rawdev_ops = {
1108         .dev_info_get = ifpga_rawdev_info_get,
1109         .dev_configure = ifpga_rawdev_configure,
1110         .dev_start = ifpga_rawdev_start,
1111         .dev_stop = ifpga_rawdev_stop,
1112         .dev_close = ifpga_rawdev_close,
1113         .dev_reset = ifpga_rawdev_reset,
1114
1115         .queue_def_conf = NULL,
1116         .queue_setup = NULL,
1117         .queue_release = NULL,
1118
1119         .attr_get = ifpga_rawdev_get_attr,
1120         .attr_set = NULL,
1121
1122         .enqueue_bufs = NULL,
1123         .dequeue_bufs = NULL,
1124
1125         .dump = NULL,
1126
1127         .xstats_get = NULL,
1128         .xstats_get_names = NULL,
1129         .xstats_get_by_name = NULL,
1130         .xstats_reset = NULL,
1131
1132         .firmware_status_get = NULL,
1133         .firmware_version_get = NULL,
1134         .firmware_load = ifpga_rawdev_pr,
1135         .firmware_unload = NULL,
1136
1137         .dev_selftest = NULL,
1138 };
1139
1140 static int
1141 ifpga_get_fme_error_prop(struct opae_manager *mgr,
1142                 u64 prop_id, u64 *val)
1143 {
1144         struct feature_prop prop;
1145
1146         prop.feature_id = IFPGA_FME_FEATURE_ID_GLOBAL_ERR;
1147         prop.prop_id = prop_id;
1148
1149         if (opae_manager_ifpga_get_prop(mgr, &prop))
1150                 return -EINVAL;
1151
1152         *val = prop.data;
1153
1154         return 0;
1155 }
1156
1157 static int
1158 ifpga_set_fme_error_prop(struct opae_manager *mgr,
1159                 u64 prop_id, u64 val)
1160 {
1161         struct feature_prop prop;
1162
1163         prop.feature_id = IFPGA_FME_FEATURE_ID_GLOBAL_ERR;
1164         prop.prop_id = prop_id;
1165
1166         prop.data = val;
1167
1168         if (opae_manager_ifpga_set_prop(mgr, &prop))
1169                 return -EINVAL;
1170
1171         return 0;
1172 }
1173
1174 static int
1175 fme_err_read_seu_emr(struct opae_manager *mgr)
1176 {
1177         u64 val;
1178         int ret;
1179
1180         ret = ifpga_get_fme_error_prop(mgr, FME_ERR_PROP_SEU_EMR_LOW, &val);
1181         if (ret)
1182                 return -EINVAL;
1183
1184         IFPGA_RAWDEV_PMD_INFO("seu emr low: 0x%" PRIx64 "\n", val);
1185
1186         ret = ifpga_get_fme_error_prop(mgr, FME_ERR_PROP_SEU_EMR_HIGH, &val);
1187         if (ret)
1188                 return -EINVAL;
1189
1190         IFPGA_RAWDEV_PMD_INFO("seu emr high: 0x%" PRIx64 "\n", val);
1191
1192         return 0;
1193 }
1194
1195 static int fme_clear_warning_intr(struct opae_manager *mgr)
1196 {
1197         u64 val;
1198
1199         if (ifpga_set_fme_error_prop(mgr, FME_ERR_PROP_INJECT_ERRORS, 0))
1200                 return -EINVAL;
1201
1202         if (ifpga_get_fme_error_prop(mgr, FME_ERR_PROP_NONFATAL_ERRORS, &val))
1203                 return -EINVAL;
1204         if ((val & 0x40) != 0)
1205                 IFPGA_RAWDEV_PMD_INFO("clean not done\n");
1206
1207         return 0;
1208 }
1209
1210 static int fme_clean_fme_error(struct opae_manager *mgr)
1211 {
1212         u64 val;
1213
1214         if (ifpga_get_fme_error_prop(mgr, FME_ERR_PROP_ERRORS, &val))
1215                 return -EINVAL;
1216
1217         IFPGA_RAWDEV_PMD_DEBUG("before clean 0x%" PRIx64 "\n", val);
1218
1219         ifpga_set_fme_error_prop(mgr, FME_ERR_PROP_CLEAR, val);
1220
1221         if (ifpga_get_fme_error_prop(mgr, FME_ERR_PROP_ERRORS, &val))
1222                 return -EINVAL;
1223
1224         IFPGA_RAWDEV_PMD_DEBUG("after clean 0x%" PRIx64 "\n", val);
1225
1226         return 0;
1227 }
1228
1229 static int
1230 fme_err_handle_error0(struct opae_manager *mgr)
1231 {
1232         struct feature_fme_error0 fme_error0;
1233         u64 val;
1234
1235         if (ifpga_get_fme_error_prop(mgr, FME_ERR_PROP_ERRORS, &val))
1236                 return -EINVAL;
1237
1238         if (fme_clean_fme_error(mgr))
1239                 return -EINVAL;
1240
1241         fme_error0.csr = val;
1242
1243         if (fme_error0.fabric_err)
1244                 IFPGA_RAWDEV_PMD_ERR("Fabric error\n");
1245         else if (fme_error0.fabfifo_overflow)
1246                 IFPGA_RAWDEV_PMD_ERR("Fabric fifo under/overflow error\n");
1247         else if (fme_error0.afu_acc_mode_err)
1248                 IFPGA_RAWDEV_PMD_ERR("AFU PF/VF access mismatch detected\n");
1249         else if (fme_error0.pcie0cdc_parity_err)
1250                 IFPGA_RAWDEV_PMD_ERR("PCIe0 CDC Parity Error\n");
1251         else if (fme_error0.cvlcdc_parity_err)
1252                 IFPGA_RAWDEV_PMD_ERR("CVL CDC Parity Error\n");
1253         else if (fme_error0.fpgaseuerr)
1254                 fme_err_read_seu_emr(mgr);
1255
1256         /* clean the errors */
1257         if (ifpga_set_fme_error_prop(mgr, FME_ERR_PROP_ERRORS, val))
1258                 return -EINVAL;
1259
1260         return 0;
1261 }
1262
1263 static int
1264 fme_err_handle_catfatal_error(struct opae_manager *mgr)
1265 {
1266         struct feature_fme_ras_catfaterror fme_catfatal;
1267         u64 val;
1268
1269         if (ifpga_get_fme_error_prop(mgr, FME_ERR_PROP_CATFATAL_ERRORS, &val))
1270                 return -EINVAL;
1271
1272         fme_catfatal.csr = val;
1273
1274         if (fme_catfatal.cci_fatal_err)
1275                 IFPGA_RAWDEV_PMD_ERR("CCI error detected\n");
1276         else if (fme_catfatal.fabric_fatal_err)
1277                 IFPGA_RAWDEV_PMD_ERR("Fabric fatal error detected\n");
1278         else if (fme_catfatal.pcie_poison_err)
1279                 IFPGA_RAWDEV_PMD_ERR("Poison error from PCIe ports\n");
1280         else if (fme_catfatal.inject_fata_err)
1281                 IFPGA_RAWDEV_PMD_ERR("Injected Fatal Error\n");
1282         else if (fme_catfatal.crc_catast_err)
1283                 IFPGA_RAWDEV_PMD_ERR("a catastrophic EDCRC error\n");
1284         else if (fme_catfatal.injected_catast_err)
1285                 IFPGA_RAWDEV_PMD_ERR("Injected Catastrophic Error\n");
1286         else if (fme_catfatal.bmc_seu_catast_err)
1287                 fme_err_read_seu_emr(mgr);
1288
1289         return 0;
1290 }
1291
1292 static int
1293 fme_err_handle_nonfaterror(struct opae_manager *mgr)
1294 {
1295         struct feature_fme_ras_nonfaterror nonfaterr;
1296         u64 val;
1297
1298         if (ifpga_get_fme_error_prop(mgr, FME_ERR_PROP_NONFATAL_ERRORS, &val))
1299                 return -EINVAL;
1300
1301         nonfaterr.csr = val;
1302
1303         if (nonfaterr.temp_thresh_ap1)
1304                 IFPGA_RAWDEV_PMD_INFO("Temperature threshold triggered AP1\n");
1305         else if (nonfaterr.temp_thresh_ap2)
1306                 IFPGA_RAWDEV_PMD_INFO("Temperature threshold triggered AP2\n");
1307         else if (nonfaterr.pcie_error)
1308                 IFPGA_RAWDEV_PMD_INFO("an error has occurred in pcie\n");
1309         else if (nonfaterr.portfatal_error)
1310                 IFPGA_RAWDEV_PMD_INFO("fatal error occurred in AFU port.\n");
1311         else if (nonfaterr.proc_hot)
1312                 IFPGA_RAWDEV_PMD_INFO("a ProcHot event\n");
1313         else if (nonfaterr.afu_acc_mode_err)
1314                 IFPGA_RAWDEV_PMD_INFO("an AFU PF/VF access mismatch\n");
1315         else if (nonfaterr.injected_nonfata_err) {
1316                 IFPGA_RAWDEV_PMD_INFO("Injected Warning Error\n");
1317                 fme_clear_warning_intr(mgr);
1318         } else if (nonfaterr.temp_thresh_AP6)
1319                 IFPGA_RAWDEV_PMD_INFO("Temperature threshold triggered AP6\n");
1320         else if (nonfaterr.power_thresh_AP1)
1321                 IFPGA_RAWDEV_PMD_INFO("Power threshold triggered AP1\n");
1322         else if (nonfaterr.power_thresh_AP2)
1323                 IFPGA_RAWDEV_PMD_INFO("Power threshold triggered AP2\n");
1324         else if (nonfaterr.mbp_err)
1325                 IFPGA_RAWDEV_PMD_INFO("an MBP event\n");
1326
1327         return 0;
1328 }
1329
1330 static void
1331 fme_interrupt_handler(void *param)
1332 {
1333         struct opae_manager *mgr = (struct opae_manager *)param;
1334
1335         IFPGA_RAWDEV_PMD_INFO("%s interrupt occurred\n", __func__);
1336
1337         fme_err_handle_error0(mgr);
1338         fme_err_handle_nonfaterror(mgr);
1339         fme_err_handle_catfatal_error(mgr);
1340 }
1341
1342 int
1343 ifpga_unregister_msix_irq(enum ifpga_irq_type type,
1344                 int vec_start, rte_intr_callback_fn handler, void *arg)
1345 {
1346         struct rte_intr_handle *intr_handle;
1347
1348         if (type == IFPGA_FME_IRQ)
1349                 intr_handle = &ifpga_irq_handle[0];
1350         else if (type == IFPGA_AFU_IRQ)
1351                 intr_handle = &ifpga_irq_handle[vec_start + 1];
1352         else
1353                 return 0;
1354
1355         rte_intr_efd_disable(intr_handle);
1356
1357         return rte_intr_callback_unregister(intr_handle, handler, arg);
1358 }
1359
1360 int
1361 ifpga_register_msix_irq(struct rte_rawdev *dev, int port_id,
1362                 enum ifpga_irq_type type, int vec_start, int count,
1363                 rte_intr_callback_fn handler, const char *name,
1364                 void *arg)
1365 {
1366         int ret;
1367         struct rte_intr_handle *intr_handle;
1368         struct opae_adapter *adapter;
1369         struct opae_manager *mgr;
1370         struct opae_accelerator *acc;
1371
1372         adapter = ifpga_rawdev_get_priv(dev);
1373         if (!adapter)
1374                 return -ENODEV;
1375
1376         mgr = opae_adapter_get_mgr(adapter);
1377         if (!mgr)
1378                 return -ENODEV;
1379
1380         if (type == IFPGA_FME_IRQ) {
1381                 intr_handle = &ifpga_irq_handle[0];
1382                 count = 1;
1383         } else if (type == IFPGA_AFU_IRQ) {
1384                 intr_handle = &ifpga_irq_handle[vec_start + 1];
1385         } else {
1386                 return -EINVAL;
1387         }
1388
1389         intr_handle->type = RTE_INTR_HANDLE_VFIO_MSIX;
1390
1391         ret = rte_intr_efd_enable(intr_handle, count);
1392         if (ret)
1393                 return -ENODEV;
1394
1395         intr_handle->fd = intr_handle->efds[0];
1396
1397         IFPGA_RAWDEV_PMD_DEBUG("register %s irq, vfio_fd=%d, fd=%d\n",
1398                         name, intr_handle->vfio_dev_fd,
1399                         intr_handle->fd);
1400
1401         if (type == IFPGA_FME_IRQ) {
1402                 struct fpga_fme_err_irq_set err_irq_set;
1403                 err_irq_set.evtfd = intr_handle->efds[0];
1404
1405                 ret = opae_manager_ifpga_set_err_irq(mgr, &err_irq_set);
1406                 if (ret)
1407                         return -EINVAL;
1408         } else if (type == IFPGA_AFU_IRQ) {
1409                 acc = opae_adapter_get_acc(adapter, port_id);
1410                 if (!acc)
1411                         return -EINVAL;
1412
1413                 ret = opae_acc_set_irq(acc, vec_start, count,
1414                                 intr_handle->efds);
1415                 if (ret)
1416                         return -EINVAL;
1417         }
1418
1419         /* register interrupt handler using DPDK API */
1420         ret = rte_intr_callback_register(intr_handle,
1421                         handler, (void *)arg);
1422         if (ret)
1423                 return -EINVAL;
1424
1425         IFPGA_RAWDEV_PMD_INFO("success register %s interrupt\n", name);
1426
1427         return 0;
1428 }
1429
1430 static int
1431 ifpga_rawdev_create(struct rte_pci_device *pci_dev,
1432                         int socket_id)
1433 {
1434         int ret = 0;
1435         struct rte_rawdev *rawdev = NULL;
1436         struct ifpga_rawdev *dev = NULL;
1437         struct opae_adapter *adapter = NULL;
1438         struct opae_manager *mgr = NULL;
1439         struct opae_adapter_data_pci *data = NULL;
1440         char name[RTE_RAWDEV_NAME_MAX_LEN];
1441         int i;
1442
1443         if (!pci_dev) {
1444                 IFPGA_RAWDEV_PMD_ERR("Invalid pci_dev of the device!");
1445                 ret = -EINVAL;
1446                 goto cleanup;
1447         }
1448
1449         memset(name, 0, sizeof(name));
1450         snprintf(name, RTE_RAWDEV_NAME_MAX_LEN, "IFPGA:%02x:%02x.%x",
1451                 pci_dev->addr.bus, pci_dev->addr.devid, pci_dev->addr.function);
1452
1453         IFPGA_RAWDEV_PMD_INFO("Init %s on NUMA node %d", name, rte_socket_id());
1454
1455         /* Allocate device structure */
1456         rawdev = rte_rawdev_pmd_allocate(name, sizeof(struct opae_adapter),
1457                                          socket_id);
1458         if (rawdev == NULL) {
1459                 IFPGA_RAWDEV_PMD_ERR("Unable to allocate rawdevice");
1460                 ret = -EINVAL;
1461                 goto cleanup;
1462         }
1463
1464         ipn3ke_bridge_func.get_ifpga_rawdev = ifpga_rawdev_get;
1465         ipn3ke_bridge_func.set_i40e_sw_dev = rte_pmd_i40e_set_switch_dev;
1466
1467         dev = ifpga_rawdev_allocate(rawdev);
1468         if (dev == NULL) {
1469                 IFPGA_RAWDEV_PMD_ERR("Unable to allocate ifpga_rawdevice");
1470                 ret = -EINVAL;
1471                 goto cleanup;
1472         }
1473         dev->aer_enable = 0;
1474
1475         /* alloc OPAE_FPGA_PCI data to register to OPAE hardware level API */
1476         data = opae_adapter_data_alloc(OPAE_FPGA_PCI);
1477         if (!data) {
1478                 ret = -ENOMEM;
1479                 goto cleanup;
1480         }
1481
1482         /* init opae_adapter_data_pci for device specific information */
1483         for (i = 0; i < PCI_MAX_RESOURCE; i++) {
1484                 data->region[i].phys_addr = pci_dev->mem_resource[i].phys_addr;
1485                 data->region[i].len = pci_dev->mem_resource[i].len;
1486                 data->region[i].addr = pci_dev->mem_resource[i].addr;
1487         }
1488         data->device_id = pci_dev->id.device_id;
1489         data->vendor_id = pci_dev->id.vendor_id;
1490         data->bus = pci_dev->addr.bus;
1491         data->devid = pci_dev->addr.devid;
1492         data->function = pci_dev->addr.function;
1493         data->vfio_dev_fd = pci_dev->intr_handle.vfio_dev_fd;
1494
1495         adapter = rawdev->dev_private;
1496         /* create a opae_adapter based on above device data */
1497         ret = opae_adapter_init(adapter, pci_dev->device.name, data);
1498         if (ret) {
1499                 ret = -ENOMEM;
1500                 goto free_adapter_data;
1501         }
1502
1503         rawdev->dev_ops = &ifpga_rawdev_ops;
1504         rawdev->device = &pci_dev->device;
1505         rawdev->driver_name = pci_dev->driver->driver.name;
1506
1507         /* must enumerate the adapter before use it */
1508         ret = opae_adapter_enumerate(adapter);
1509         if (ret)
1510                 goto free_adapter_data;
1511
1512         /* get opae_manager to rawdev */
1513         mgr = opae_adapter_get_mgr(adapter);
1514         if (mgr) {
1515                 /* PF function */
1516                 IFPGA_RAWDEV_PMD_INFO("this is a PF function");
1517         }
1518
1519         ret = ifpga_register_msix_irq(rawdev, 0, IFPGA_FME_IRQ, 0, 0,
1520                         fme_interrupt_handler, "fme_irq", mgr);
1521         if (ret)
1522                 goto free_adapter_data;
1523
1524         return ret;
1525
1526 free_adapter_data:
1527         if (data)
1528                 opae_adapter_data_free(data);
1529 cleanup:
1530         if (rawdev)
1531                 rte_rawdev_pmd_release(rawdev);
1532
1533         return ret;
1534 }
1535
1536 static int
1537 ifpga_rawdev_destroy(struct rte_pci_device *pci_dev)
1538 {
1539         int ret;
1540         struct rte_rawdev *rawdev;
1541         char name[RTE_RAWDEV_NAME_MAX_LEN];
1542         struct opae_adapter *adapter;
1543         struct opae_manager *mgr;
1544         struct ifpga_rawdev *dev;
1545
1546         if (!pci_dev) {
1547                 IFPGA_RAWDEV_PMD_ERR("Invalid pci_dev of the device!");
1548                 ret = -EINVAL;
1549                 return ret;
1550         }
1551
1552         memset(name, 0, sizeof(name));
1553         snprintf(name, RTE_RAWDEV_NAME_MAX_LEN, "IFPGA:%x:%02x.%x",
1554                 pci_dev->addr.bus, pci_dev->addr.devid, pci_dev->addr.function);
1555
1556         IFPGA_RAWDEV_PMD_INFO("Closing %s on NUMA node %d",
1557                 name, rte_socket_id());
1558
1559         rawdev = rte_rawdev_pmd_get_named_dev(name);
1560         if (!rawdev) {
1561                 IFPGA_RAWDEV_PMD_ERR("Invalid device name (%s)", name);
1562                 return -EINVAL;
1563         }
1564         dev = ifpga_rawdev_get(rawdev);
1565         if (dev)
1566                 dev->rawdev = NULL;
1567
1568         adapter = ifpga_rawdev_get_priv(rawdev);
1569         if (!adapter)
1570                 return -ENODEV;
1571
1572         mgr = opae_adapter_get_mgr(adapter);
1573         if (!mgr)
1574                 return -ENODEV;
1575
1576         if (ifpga_unregister_msix_irq(IFPGA_FME_IRQ, 0,
1577                                 fme_interrupt_handler, mgr) < 0)
1578                 return -EINVAL;
1579
1580         /* rte_rawdev_close is called by pmd_release */
1581         ret = rte_rawdev_pmd_release(rawdev);
1582         if (ret)
1583                 IFPGA_RAWDEV_PMD_DEBUG("Device cleanup failed");
1584
1585         return ret;
1586 }
1587
1588 static int
1589 ifpga_rawdev_pci_probe(struct rte_pci_driver *pci_drv __rte_unused,
1590         struct rte_pci_device *pci_dev)
1591 {
1592         IFPGA_RAWDEV_PMD_FUNC_TRACE();
1593         return ifpga_rawdev_create(pci_dev, rte_socket_id());
1594 }
1595
1596 static int
1597 ifpga_rawdev_pci_remove(struct rte_pci_device *pci_dev)
1598 {
1599         ifpga_monitor_stop_func();
1600         return ifpga_rawdev_destroy(pci_dev);
1601 }
1602
1603 static struct rte_pci_driver rte_ifpga_rawdev_pmd = {
1604         .id_table  = pci_ifpga_map,
1605         .drv_flags = RTE_PCI_DRV_NEED_MAPPING,
1606         .probe     = ifpga_rawdev_pci_probe,
1607         .remove    = ifpga_rawdev_pci_remove,
1608 };
1609
1610 RTE_PMD_REGISTER_PCI(ifpga_rawdev_pci_driver, rte_ifpga_rawdev_pmd);
1611 RTE_PMD_REGISTER_PCI_TABLE(ifpga_rawdev_pci_driver, rte_ifpga_rawdev_pmd);
1612 RTE_PMD_REGISTER_KMOD_DEP(ifpga_rawdev_pci_driver, "* igb_uio | uio_pci_generic | vfio-pci");
1613 RTE_LOG_REGISTER(ifpga_rawdev_logtype, driver.raw.init, NOTICE);
1614
1615 static const char * const valid_args[] = {
1616 #define IFPGA_ARG_NAME         "ifpga"
1617         IFPGA_ARG_NAME,
1618 #define IFPGA_ARG_PORT         "port"
1619         IFPGA_ARG_PORT,
1620 #define IFPGA_AFU_BTS          "afu_bts"
1621         IFPGA_AFU_BTS,
1622         NULL
1623 };
1624
1625 static int ifpga_rawdev_get_string_arg(const char *key __rte_unused,
1626         const char *value, void *extra_args)
1627 {
1628         int size;
1629         if (!value || !extra_args)
1630                 return -EINVAL;
1631
1632         size = strlen(value) + 1;
1633         *(char **)extra_args = rte_malloc(NULL, size, RTE_CACHE_LINE_SIZE);
1634         if (!*(char **)extra_args)
1635                 return -ENOMEM;
1636
1637         strlcpy(*(char **)extra_args, value, size);
1638
1639         return 0;
1640 }
1641 static int
1642 ifpga_cfg_probe(struct rte_vdev_device *dev)
1643 {
1644         struct rte_devargs *devargs;
1645         struct rte_kvargs *kvlist = NULL;
1646         struct rte_rawdev *rawdev = NULL;
1647         struct ifpga_rawdev *ifpga_dev;
1648         int port;
1649         char *name = NULL;
1650         const char *bdf;
1651         char dev_name[RTE_RAWDEV_NAME_MAX_LEN];
1652         int ret = -1;
1653
1654         devargs = dev->device.devargs;
1655
1656         kvlist = rte_kvargs_parse(devargs->args, valid_args);
1657         if (!kvlist) {
1658                 IFPGA_RAWDEV_PMD_LOG(ERR, "error when parsing param");
1659                 goto end;
1660         }
1661
1662         if (rte_kvargs_count(kvlist, IFPGA_ARG_NAME) == 1) {
1663                 if (rte_kvargs_process(kvlist, IFPGA_ARG_NAME,
1664                                        &ifpga_rawdev_get_string_arg,
1665                                        &name) < 0) {
1666                         IFPGA_RAWDEV_PMD_ERR("error to parse %s",
1667                                      IFPGA_ARG_NAME);
1668                         goto end;
1669                 }
1670         } else {
1671                 IFPGA_RAWDEV_PMD_ERR("arg %s is mandatory for ifpga bus",
1672                           IFPGA_ARG_NAME);
1673                 goto end;
1674         }
1675
1676         if (rte_kvargs_count(kvlist, IFPGA_ARG_PORT) == 1) {
1677                 if (rte_kvargs_process(kvlist,
1678                         IFPGA_ARG_PORT,
1679                         &rte_ifpga_get_integer32_arg,
1680                         &port) < 0) {
1681                         IFPGA_RAWDEV_PMD_ERR("error to parse %s",
1682                                 IFPGA_ARG_PORT);
1683                         goto end;
1684                 }
1685         } else {
1686                 IFPGA_RAWDEV_PMD_ERR("arg %s is mandatory for ifpga bus",
1687                           IFPGA_ARG_PORT);
1688                 goto end;
1689         }
1690
1691         memset(dev_name, 0, sizeof(dev_name));
1692         snprintf(dev_name, RTE_RAWDEV_NAME_MAX_LEN, "IFPGA:%s", name);
1693         rawdev = rte_rawdev_pmd_get_named_dev(dev_name);
1694         if (!rawdev)
1695                 goto end;
1696         ifpga_dev = ifpga_rawdev_get(rawdev);
1697         if (!ifpga_dev)
1698                 goto end;
1699         bdf = name;
1700         ifpga_rawdev_fill_info(ifpga_dev, bdf);
1701
1702         ifpga_monitor_start_func();
1703
1704         memset(dev_name, 0, sizeof(dev_name));
1705         snprintf(dev_name, RTE_RAWDEV_NAME_MAX_LEN, "%d|%s",
1706         port, name);
1707
1708         ret = rte_eal_hotplug_add(RTE_STR(IFPGA_BUS_NAME),
1709                         dev_name, devargs->args);
1710 end:
1711         if (kvlist)
1712                 rte_kvargs_free(kvlist);
1713         if (name)
1714                 free(name);
1715
1716         return ret;
1717 }
1718
1719 static int
1720 ifpga_cfg_remove(struct rte_vdev_device *vdev)
1721 {
1722         IFPGA_RAWDEV_PMD_INFO("Remove ifpga_cfg %p",
1723                 vdev);
1724
1725         return 0;
1726 }
1727
1728 static struct rte_vdev_driver ifpga_cfg_driver = {
1729         .probe = ifpga_cfg_probe,
1730         .remove = ifpga_cfg_remove,
1731 };
1732
1733 RTE_PMD_REGISTER_VDEV(ifpga_rawdev_cfg, ifpga_cfg_driver);
1734 RTE_PMD_REGISTER_ALIAS(ifpga_rawdev_cfg, ifpga_cfg);
1735 RTE_PMD_REGISTER_PARAM_STRING(ifpga_rawdev_cfg,
1736         "ifpga=<string> "
1737         "port=<int> "
1738         "afu_bts=<path>");