|
| 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 | + |
| 14 | +static __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 | + |
| 48 | +static const struct mips_fdt_fixup realtek_fdt_fixups[] __initconst = { |
| 49 | + { realtek_add_initrd, "add initrd" }, |
| 50 | + {}, |
| 51 | +}; |
| 52 | + |
| 53 | +static __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 | + |
| 71 | +static const struct of_device_id realtek_of_match[] __initconst = { |
| 72 | + { .compatible = "realtek,rtl9302-soc" }, |
| 73 | + {} |
| 74 | +}; |
| 75 | + |
| 76 | +MIPS_MACHINE(realtek) = { |
| 77 | + .matches = realtek_of_match, |
| 78 | + .fixup_fdt = realtek_fixup_fdt, |
| 79 | +}; |
0 commit comments