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 struct platform_device * __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 18 return platform_device_register_simple("virtio-mmio", id, 19 res, ARRAY_SIZE(res)); 20 } 21 22 static int __init virt_platform_init(void) 23 { 24 const struct resource goldfish_tty_res[] = { 25 DEFINE_RES_MEM(virt_bi_data.tty.mmio, 1), 26 DEFINE_RES_IRQ(virt_bi_data.tty.irq), 27 }; 28 /* this is the second gf-rtc, the first one is used by the scheduler */ 29 const struct resource goldfish_rtc_res[] = { 30 DEFINE_RES_MEM(virt_bi_data.rtc.mmio + 0x1000, 0x1000), 31 DEFINE_RES_IRQ(virt_bi_data.rtc.irq + 1), 32 }; 33 const struct resource virt_ctrl_res[] = { 34 DEFINE_RES_MEM(virt_bi_data.ctrl.mmio, 0x100), 35 }; 36 struct platform_device *pdev1, *pdev2, *pdev3; 37 struct platform_device *pdevs[VIRTIO_BUS_NB]; 38 unsigned int i; 39 int ret = 0; 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 pdev1 = platform_device_register_simple("goldfish_tty", 48 PLATFORM_DEVID_NONE, 49 goldfish_tty_res, 50 ARRAY_SIZE(goldfish_tty_res)); 51 if (IS_ERR(pdev1)) 52 return PTR_ERR(pdev1); 53 54 pdev2 = platform_device_register_simple("goldfish_rtc", 55 PLATFORM_DEVID_NONE, 56 goldfish_rtc_res, 57 ARRAY_SIZE(goldfish_rtc_res)); 58 if (IS_ERR(pdev2)) { 59 ret = PTR_ERR(pdev2); 60 goto err_unregister_tty; 61 } 62 63 pdev3 = platform_device_register_simple("qemu-virt-ctrl", 64 PLATFORM_DEVID_NONE, 65 virt_ctrl_res, 66 ARRAY_SIZE(virt_ctrl_res)); 67 if (IS_ERR(pdev3)) { 68 ret = PTR_ERR(pdev3); 69 goto err_unregister_rtc; 70 } 71 72 for (i = 0; i < VIRTIO_BUS_NB; i++) { 73 pdevs[i] = virt_virtio_init(i); 74 if (IS_ERR(pdevs[i])) { 75 ret = PTR_ERR(pdevs[i]); 76 goto err_unregister_virtio; 77 } 78 } 79 80 return 0; 81 82 err_unregister_virtio: 83 while (i > 0) 84 platform_device_unregister(pdevs[--i]); 85 platform_device_unregister(pdev3); 86 err_unregister_rtc: 87 platform_device_unregister(pdev2); 88 err_unregister_tty: 89 platform_device_unregister(pdev1); 90 91 return ret; 92 } 93 94 arch_initcall(virt_platform_init); 95