uio_dfl.c (1619B)
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 14static 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 50static const struct dfl_device_id uio_dfl_ids[] = { 51 { FME_ID, FME_FEATURE_ID_ETH_GROUP }, 52 { FME_ID, FME_FEATURE_ID_HSSI_SUBSYS }, 53 { } 54}; 55MODULE_DEVICE_TABLE(dfl, uio_dfl_ids); 56 57static struct dfl_driver uio_dfl_driver = { 58 .drv = { 59 .name = DRIVER_NAME, 60 }, 61 .id_table = uio_dfl_ids, 62 .probe = uio_dfl_probe, 63}; 64module_dfl_driver(uio_dfl_driver); 65 66MODULE_DESCRIPTION("Generic DFL driver for Userspace I/O devices"); 67MODULE_AUTHOR("Intel Corporation"); 68MODULE_LICENSE("GPL v2");