arch/m68k/virt/platform.c

   1 // SPDX-License-Identifier: GPL-2.0
   2
   3 #include <linux/platform_device.h>
   4 #include <linux/interrupt.h>
   5 #include <linux/memblock.h>
   6 #include <asm/virt.h>
   7 #include <asm/irq.h>
   8
   9 #define VIRTIO_BUS_NB   128
  10
  11 static int __init virt_virtio_init(unsigned int id)
  12 {
  13         const struct resource res[] = {
  14                 DEFINE_RES_MEM(virt_bi_data.virtio.mmio + id * 0x200, 0x200),
  15                 DEFINE_RES_IRQ(virt_bi_data.virtio.irq + id),
  16         };
  17         struct platform_device *pdev;
  18
  19         pdev = platform_device_register_simple("virtio-mmio", id,
  20                                                res, ARRAY_SIZE(res));
  21         if (IS_ERR(pdev))
  22                 return PTR_ERR(pdev);
  23
  24         return 0;
  25 }
  26
  27 static int __init virt_platform_init(void)
  28 {
  29         const struct resource goldfish_tty_res[] = {
  30                 DEFINE_RES_MEM(virt_bi_data.tty.mmio, 1),
  31                 DEFINE_RES_IRQ(virt_bi_data.tty.irq),
  32         };
  33         /* this is the second gf-rtc, the first one is used by the scheduler */
  34         const struct resource goldfish_rtc_res[] = {
  35                 DEFINE_RES_MEM(virt_bi_data.rtc.mmio + 0x1000, 0x1000),
  36                 DEFINE_RES_IRQ(virt_bi_data.rtc.irq + 1),
  37         };
  38         struct platform_device *pdev;
  39         unsigned int i;
  40
  41         if (!MACH_IS_VIRT)
  42                 return -ENODEV;
  43
  44         /* We need this to have DMA'able memory provided to goldfish-tty */
  45         min_low_pfn = 0;
  46
  47         pdev = platform_device_register_simple("goldfish_tty",
  48                                                PLATFORM_DEVID_NONE,
  49                                                goldfish_tty_res,
  50                                                ARRAY_SIZE(goldfish_tty_res));
  51         if (IS_ERR(pdev))
  52                 return PTR_ERR(pdev);
  53
  54         pdev = platform_device_register_simple("goldfish_rtc",
  55                                                PLATFORM_DEVID_NONE,
  56                                                goldfish_rtc_res,
  57                                                ARRAY_SIZE(goldfish_rtc_res));
  58         if (IS_ERR(pdev))
  59                 return PTR_ERR(pdev);
  60
  61         for (i = 0; i < VIRTIO_BUS_NB; i++) {
  62                 int err;
  63
  64                 err = virt_virtio_init(i);
  65                 if (err)
  66                         return err;
  67         }
  68
  69         return 0;
  70 }
  71
  72 arch_initcall(virt_platform_init);