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/dma-mapping.h>
   9 #include <linux/list.h>
  10 #include <linux/nubus.h>
  11 #include <linux/seq_file.h>
  12 #include <linux/slab.h>
  13
  14 #define to_nubus_board(d)       container_of(d, struct nubus_board, dev)
  15 #define to_nubus_driver(d)      container_of(d, struct nubus_driver, driver)
  16
  17 static int nubus_device_probe(struct device *dev)
  18 {
  19         struct nubus_driver *ndrv = to_nubus_driver(dev->driver);
  20         int err = -ENODEV;
  21
  22         if (ndrv->probe)
  23                 err = ndrv->probe(to_nubus_board(dev));
  24         return err;
  25 }
  26
  27 static void nubus_device_remove(struct device *dev)
  28 {
  29         struct nubus_driver *ndrv = to_nubus_driver(dev->driver);
  30
  31         if (ndrv->remove)
  32                 ndrv->remove(to_nubus_board(dev));
  33 }
  34
  35 struct bus_type nubus_bus_type = {
  36         .name           = "nubus",
  37         .probe          = nubus_device_probe,
  38         .remove         = nubus_device_remove,
  39 };
  40 EXPORT_SYMBOL(nubus_bus_type);
  41
  42 int nubus_driver_register(struct nubus_driver *ndrv)
  43 {
  44         ndrv->driver.bus = &nubus_bus_type;
  45         return driver_register(&ndrv->driver);
  46 }
  47 EXPORT_SYMBOL(nubus_driver_register);
  48
  49 void nubus_driver_unregister(struct nubus_driver *ndrv)
  50 {
  51         driver_unregister(&ndrv->driver);
  52 }
  53 EXPORT_SYMBOL(nubus_driver_unregister);
  54
  55 static struct device nubus_parent = {
  56         .init_name      = "nubus",
  57 };
  58
  59 static int __init nubus_bus_register(void)
  60 {
  61         return bus_register(&nubus_bus_type);
  62 }
  63 postcore_initcall(nubus_bus_register);
  64
  65 int __init nubus_parent_device_register(void)
  66 {
  67         return device_register(&nubus_parent);
  68 }
  69
  70 static void nubus_device_release(struct device *dev)
  71 {
  72         struct nubus_board *board = to_nubus_board(dev);
  73         struct nubus_rsrc *fres, *tmp;
  74
  75         list_for_each_entry_safe(fres, tmp, &nubus_func_rsrcs, list)
  76                 if (fres->board == board) {
  77                         list_del(&fres->list);
  78                         kfree(fres);
  79                 }
  80         kfree(board);
  81 }
  82
  83 int nubus_device_register(struct nubus_board *board)
  84 {
  85         board->dev.parent = &nubus_parent;
  86         board->dev.release = nubus_device_release;
  87         board->dev.bus = &nubus_bus_type;
  88         dev_set_name(&board->dev, "slot.%X", board->slot);
  89         board->dev.dma_mask = &board->dev.coherent_dma_mask;
  90         dma_set_mask(&board->dev, DMA_BIT_MASK(32));
  91         return device_register(&board->dev);
  92 }
  93
  94 static int nubus_print_device_name_fn(struct device *dev, void *data)
  95 {
  96         struct nubus_board *board = to_nubus_board(dev);
  97         struct seq_file *m = data;
  98
  99         seq_printf(m, "Slot %X: %s\n", board->slot, board->name);
 100         return 0;
 101 }
 102
 103 int nubus_proc_show(struct seq_file *m, void *data)
 104 {
 105         return bus_for_each_dev(&nubus_bus_type, NULL, m,
 106                                 nubus_print_device_name_fn);
 107 }