FPGA/corundum
1
0
Fork 0
mirror of https://github.com/corundum/corundum.git synced 2025-01-30 08:32:52 +08:00
Code Issues Projects Releases Wiki Activity

modules/mqnic: Add support for extension kernel modules using the auxiliary bus

Browse Source 
Signed-off-by: Alex Forencich <alex@alexforencich.com>
This commit is contained in:
Alex Forencich 2022-04-21 13:18:00 -07:00
parent 7f8bbe30de
commit 65a986cc89
2 changed files with 71 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

16
modules/mqnic/mqnic.h
View File

@ -40,6 +40,9 @@
#ifdef CONFIG_PCI #ifdef CONFIG_PCI
#include <linux/pci.h> #include <linux/pci.h>
#endif #endif
#ifdef CONFIG_AUXILIARY_BUS
#include <linux/auxiliary_bus.h>
#endif
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/miscdevice.h> #include <linux/miscdevice.h>
#include <linux/netdevice.h> #include <linux/netdevice.h>
@ -100,6 +103,15 @@ struct mqnic_irq {
struct atomic_notifier_head nh; struct atomic_notifier_head nh;
}; };
#ifdef CONFIG_AUXILIARY_BUS
struct mqnic_adev {
struct auxiliary_device adev;
struct mqnic_dev *mdev;
struct mqnic_adev **ptr;
char name[32];
};
#endif
struct mqnic_dev { struct mqnic_dev {
struct device *dev; struct device *dev;
#ifdef CONFIG_PCI #ifdef CONFIG_PCI
@ -135,6 +147,10 @@ struct mqnic_dev {
struct miscdevice misc_dev; struct miscdevice misc_dev;
#ifdef CONFIG_AUXILIARY_BUS
struct mqnic_adev *app_adev;
#endif
struct reg_block *rb_list; struct reg_block *rb_list;
struct reg_block *fw_id_rb; struct reg_block *fw_id_rb;
struct reg_block *if_rb; struct reg_block *if_rb;

55
modules/mqnic/mqnic_main.c
View File

@ -246,6 +246,17 @@ static int mqnic_platform_module_eeprom_get(struct mqnic_dev *mqnic)
static void mqnic_common_remove(struct mqnic_dev *mqnic); static void mqnic_common_remove(struct mqnic_dev *mqnic);
#ifdef CONFIG_AUXILIARY_BUS
static void mqnic_adev_release(struct device *dev)
{
struct mqnic_adev *mqnic_adev = container_of(dev, struct mqnic_adev, adev.dev);
if (mqnic_adev->ptr)
*mqnic_adev->ptr = NULL;
kfree(mqnic_adev);
}
#endif
static int mqnic_common_probe(struct mqnic_dev *mqnic) static int mqnic_common_probe(struct mqnic_dev *mqnic)
{ {
int ret = 0; int ret = 0;
@ -411,10 +422,47 @@ fail_create_if:
dev_info(dev, "Registered device %s", mqnic->name); dev_info(dev, "Registered device %s", mqnic->name);
#ifdef CONFIG_AUXILIARY_BUS
if (mqnic->app_id) {
mqnic->app_adev = kzalloc(sizeof(*mqnic->app_adev), GFP_KERNEL);
if (!mqnic->app_adev) {
ret = -ENOMEM;
goto fail_adev;
}
snprintf(mqnic->app_adev->name, sizeof(mqnic->app_adev->name), "app_%08x", mqnic->app_id);
mqnic->app_adev->adev.id = mqnic->id;
mqnic->app_adev->adev.name = mqnic->app_adev->name;
mqnic->app_adev->adev.dev.parent = dev;
mqnic->app_adev->adev.dev.release = mqnic_adev_release;
mqnic->app_adev->mdev = mqnic;
mqnic->app_adev->ptr = &mqnic->app_adev;
ret = auxiliary_device_init(&mqnic->app_adev->adev);
if (ret) {
kfree(mqnic->app_adev);
mqnic->app_adev = NULL;
goto fail_adev;
}
ret = auxiliary_device_add(&mqnic->app_adev->adev);
if (ret) {
auxiliary_device_uninit(&mqnic->app_adev->adev);
mqnic->app_adev = NULL;
goto fail_adev;
}
dev_info(dev, "Registered auxiliary bus device " DRIVER_NAME ".%s.%d",
mqnic->app_adev->adev.name, mqnic->app_adev->adev.id);
}
#endif
// probe complete // probe complete
return 0; return 0;
// error handling // error handling
fail_adev:
fail_miscdev: fail_miscdev:
fail_board: fail_board:
fail_bar_size: fail_bar_size:
@ -427,6 +475,13 @@ static void mqnic_common_remove(struct mqnic_dev *mqnic)
{ {
int k = 0; int k = 0;
#ifdef CONFIG_AUXILIARY_BUS
if (mqnic->app_adev) {
auxiliary_device_delete(&mqnic->app_adev->adev);
auxiliary_device_uninit(&mqnic->app_adev->adev);
}
#endif
if (mqnic->misc_dev.this_device) if (mqnic->misc_dev.this_device)
misc_deregister(&mqnic->misc_dev); misc_deregister(&mqnic->misc_dev);