arch/mips/generic/board-realtek.c

   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 };