drivers/uio/uio_dfl.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Generic DFL driver for Userspace I/O devicess
   4  *
   5  * Copyright (C) 2021 Intel Corporation, Inc.
   6  */
   7 #include <linux/dfl.h>
   8 #include <linux/errno.h>
   9 #include <linux/module.h>
  10 #include <linux/uio_driver.h>
  11
  12 #define DRIVER_NAME "uio_dfl"
  13
  14 static int uio_dfl_probe(struct dfl_device *ddev)
  15 {
  16         struct resource *r = &ddev->mmio_res;
  17         struct device *dev = &ddev->dev;
  18         struct uio_info *uioinfo;
  19         struct uio_mem *uiomem;
  20         int ret;
  21
  22         uioinfo = devm_kzalloc(dev, sizeof(struct uio_info), GFP_KERNEL);
  23         if (!uioinfo)
  24                 return -ENOMEM;
  25
  26         uioinfo->name = DRIVER_NAME;
  27         uioinfo->version = "0";
  28
  29         uiomem = &uioinfo->mem[0];
  30         uiomem->memtype = UIO_MEM_PHYS;
  31         uiomem->addr = r->start & PAGE_MASK;
  32         uiomem->offs = r->start & ~PAGE_MASK;
  33         uiomem->size = (uiomem->offs + resource_size(r)
  34                         + PAGE_SIZE - 1) & PAGE_MASK;
  35         uiomem->name = r->name;
  36
  37         /* Irq is yet to be supported */
  38         uioinfo->irq = UIO_IRQ_NONE;
  39
  40         ret = devm_uio_register_device(dev, uioinfo);
  41         if (ret)
  42                 dev_err(dev, "unable to register uio device\n");
  43
  44         return ret;
  45 }
  46
  47 #define FME_FEATURE_ID_ETH_GROUP        0x10
  48 #define FME_FEATURE_ID_HSSI_SUBSYS      0x15
  49 #define PORT_FEATURE_ID_IOPLL_USRCLK    0x14
  50
  51 static const struct dfl_device_id uio_dfl_ids[] = {
  52         { FME_ID, FME_FEATURE_ID_ETH_GROUP },
  53         { FME_ID, FME_FEATURE_ID_HSSI_SUBSYS },
  54         { PORT_ID, PORT_FEATURE_ID_IOPLL_USRCLK },
  55         { }
  56 };
  57 MODULE_DEVICE_TABLE(dfl, uio_dfl_ids);
  58
  59 static struct dfl_driver uio_dfl_driver = {
  60         .drv = {
  61                 .name = DRIVER_NAME,
  62         },
  63         .id_table       = uio_dfl_ids,
  64         .probe          = uio_dfl_probe,
  65 };
  66 module_dfl_driver(uio_dfl_driver);
  67
  68 MODULE_DESCRIPTION("Generic DFL driver for Userspace I/O devices");
  69 MODULE_AUTHOR("Intel Corporation");
  70 MODULE_LICENSE("GPL v2");