drivers/nubus/bus.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 //
   3 // Bus implementation for the NuBus subsystem.
   4 //
   5 // Copyright (C) 2017 Finn Thain
   6
   7 #include <linux/device.h>
   8 #include <linux/list.h>
   9 #include <linux/nubus.h>
  10 #include <linux/seq_file.h>
  11 #include <linux/slab.h>
  12
  13 #define to_nubus_board(d)       container_of(d, struct nubus_board, dev)
  14 #define to_nubus_driver(d)      container_of(d, struct nubus_driver, driver)
  15
  16 static int nubus_bus_match(struct device *dev, struct device_driver *driver)
  17 {
  18         return 1;
  19 }
  20
  21 static int nubus_device_probe(struct device *dev)
  22 {
  23         struct nubus_driver *ndrv = to_nubus_driver(dev->driver);
  24         int err = -ENODEV;
  25
  26         if (ndrv->probe)
  27                 err = ndrv->probe(to_nubus_board(dev));
  28         return err;
  29 }
  30
  31 static int nubus_device_remove(struct device *dev)
  32 {
  33         struct nubus_driver *ndrv = to_nubus_driver(dev->driver);
  34         int err = -ENODEV;
  35
  36         if (dev->driver && ndrv->remove)
  37                 err = ndrv->remove(to_nubus_board(dev));
  38         return err;
  39 }
  40
  41 struct bus_type nubus_bus_type = {
  42         .name           = "nubus",
  43         .match          = nubus_bus_match,
  44         .probe          = nubus_device_probe,
  45         .remove         = nubus_device_remove,
  46 };
  47 EXPORT_SYMBOL(nubus_bus_type);
  48
  49 int nubus_driver_register(struct nubus_driver *ndrv)
  50 {
  51         ndrv->driver.bus = &nubus_bus_type;
  52         return driver_register(&ndrv->driver);
  53 }
  54 EXPORT_SYMBOL(nubus_driver_register);
  55
  56 void nubus_driver_unregister(struct nubus_driver *ndrv)
  57 {
  58         driver_unregister(&ndrv->driver);
  59 }
  60 EXPORT_SYMBOL(nubus_driver_unregister);
  61
  62 static struct device nubus_parent = {
  63         .init_name      = "nubus",
  64 };
  65
  66 int __init nubus_bus_register(void)
  67 {
  68         int err;
  69
  70         err = device_register(&nubus_parent);
  71         if (err)
  72                 return err;
  73
  74         err = bus_register(&nubus_bus_type);
  75         if (!err)
  76                 return 0;
  77
  78         device_unregister(&nubus_parent);
  79         return err;
  80 }
  81
  82 static void nubus_device_release(struct device *dev)
  83 {
  84         struct nubus_board *board = to_nubus_board(dev);
  85         struct nubus_rsrc *fres, *tmp;
  86
  87         list_for_each_entry_safe(fres, tmp, &nubus_func_rsrcs, list)
  88                 if (fres->board == board) {
  89                         list_del(&fres->list);
  90                         kfree(fres);
  91                 }
  92         kfree(board);
  93 }
  94
  95 int nubus_device_register(struct nubus_board *board)
  96 {
  97         board->dev.parent = &nubus_parent;
  98         board->dev.release = nubus_device_release;
  99         board->dev.bus = &nubus_bus_type;
 100         dev_set_name(&board->dev, "slot.%X", board->slot);
 101         return device_register(&board->dev);
 102 }
 103
 104 static int nubus_print_device_name_fn(struct device *dev, void *data)
 105 {
 106         struct nubus_board *board = to_nubus_board(dev);
 107         struct seq_file *m = data;
 108
 109         seq_printf(m, "Slot %X: %s\n", board->slot, board->name);
 110         return 0;
 111 }
 112
 113 int nubus_proc_show(struct seq_file *m, void *data)
 114 {
 115         return bus_for_each_dev(&nubus_bus_type, NULL, m,
 116                                 nubus_print_device_name_fn);
 117 }