1// SPDX-License-Identifier: GPL-2.0-only
 2/*
 3 * Copyright (C) 2024 Allied Telesis
 4 */
 5
 6#include <linux/errno.h>
 7#include <linux/libfdt.h>
 8#include <linux/printk.h>
 9#include <linux/types.h>
10
11#include <asm/fw/fw.h>
12#include <asm/machine.h>
13
14static __init int realtek_add_initrd(void *fdt)
15{
16	int node, err;
17	u32 start, size;
18
19	node = fdt_path_offset(fdt, "/chosen");
20	if (node < 0) {
21		pr_err("/chosen node not found\n");
22		return -ENOENT;
23	}
24
25	start = fw_getenvl("initrd_start");
26	size = fw_getenvl("initrd_size");
27
28	if (start == 0 && size == 0)
29		return 0;
30
31	pr_info("Adding initrd info from environment\n");
32
33	err = fdt_setprop_u32(fdt, node, "linux,initrd-start", start);
34	if (err) {
35		pr_err("unable to set initrd-start: %d\n", err);
36		return err;
37	}
38
39	err = fdt_setprop_u32(fdt, node, "linux,initrd-end", start + size);
40	if (err) {
41		pr_err("unable to set initrd-end: %d\n", err);
42		return err;
43	}
44
45	return 0;
46}
47
48static const struct mips_fdt_fixup realtek_fdt_fixups[] __initconst = {
49	{ realtek_add_initrd, "add initrd" },
50	{},
51};
52
53static __init const void *realtek_fixup_fdt(const void *fdt, const void *match_data)
54{
55	static unsigned char fdt_buf[16 << 10] __initdata;
56	int err;
57
58	if (fdt_check_header(fdt))
59		panic("Corrupt DT");
60
61	fw_init_cmdline();
62
63	err = apply_mips_fdt_fixups(fdt_buf, sizeof(fdt_buf), fdt, realtek_fdt_fixups);
64	if (err)
65		panic("Unable to fixup FDT: %d", err);
66
67	return fdt_buf;
68
69}
70
71static const struct of_device_id realtek_of_match[] __initconst = {
72	{ .compatible = "realtek,rtl9302-soc" },
73	{}
74};
75
76MIPS_MACHINE(realtek) = {
77	.matches = realtek_of_match,
78	.fixup_fdt = realtek_fixup_fdt,
79};