platform.c (1738B)
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 11static 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 27static 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 72arch_initcall(virt_platform_init);