arch/mips/pic32/pic32mzda/init.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Joshua Henderson, joshua.henderson@microchip.com
   4  * Copyright (C) 2015 Microchip Technology Inc.  All rights reserved.
   5  */
   6 #include <linux/init.h>
   7 #include <linux/kernel.h>
   8 #include <linux/of_address.h>
   9 #include <linux/of_fdt.h>
  10 #include <linux/of_platform.h>
  11 #include <linux/platform_data/sdhci-pic32.h>
  12
  13 #include <asm/fw/fw.h>
  14 #include <asm/mips-boards/generic.h>
  15 #include <asm/prom.h>
  16
  17 #include "pic32mzda.h"
  18
  19 const char *get_system_type(void)
  20 {
  21         return "PIC32MZDA";
  22 }
  23
  24 void __init plat_mem_setup(void)
  25 {
  26         void *dtb;
  27
  28         dtb = get_fdt();
  29         if (!dtb) {
  30                 pr_err("pic32: no DTB found.\n");
  31                 return;
  32         }
  33
  34         /*
  35          * Load the builtin device tree. This causes the chosen node to be
  36          * parsed resulting in our memory appearing.
  37          */
  38         __dt_setup_arch(dtb);
  39
  40         pr_info("Found following command lines\n");
  41         pr_info(" boot_command_line: %s\n", boot_command_line);
  42         pr_info(" arcs_cmdline     : %s\n", arcs_cmdline);
  43 #ifdef CONFIG_CMDLINE_BOOL
  44         pr_info(" builtin_cmdline  : %s\n", CONFIG_CMDLINE);
  45 #endif
  46         if (dtb != __dtb_start)
  47                 strscpy(arcs_cmdline, boot_command_line, COMMAND_LINE_SIZE);
  48
  49 #ifdef CONFIG_EARLY_PRINTK
  50         fw_init_early_console();
  51 #endif
  52         pic32_config_init();
  53 }
  54
  55 static __init void pic32_init_cmdline(int argc, char *argv[])
  56 {
  57         unsigned int count = COMMAND_LINE_SIZE - 1;
  58         int i;
  59         char *dst = &(arcs_cmdline[0]);
  60         char *src;
  61
  62         for (i = 1; i < argc && count; ++i) {
  63                 src = argv[i];
  64                 while (*src && count) {
  65                         *dst++ = *src++;
  66                         --count;
  67                 }
  68                 *dst++ = ' ';
  69         }
  70         if (i > 1)
  71                 --dst;
  72
  73         *dst = 0;
  74 }
  75
  76 void __init prom_init(void)
  77 {
  78         pic32_init_cmdline((int)fw_arg0, (char **)fw_arg1);
  79 }
  80
  81 static struct pic32_sdhci_platform_data sdhci_data = {
  82         .setup_dma = pic32_set_sdhci_adma_fifo_threshold,
  83 };
  84
  85 static struct of_dev_auxdata pic32_auxdata_lookup[] __initdata = {
  86         OF_DEV_AUXDATA("microchip,pic32mzda-sdhci", 0, "sdhci", &sdhci_data),
  87         { /* sentinel */}
  88 };
  89
  90 static int __init pic32_of_prepare_platform_data(struct of_dev_auxdata *lookup)
  91 {
  92         struct device_node *root, *np;
  93         struct resource res;
  94
  95         root = of_find_node_by_path("/");
  96
  97         for (; lookup->compatible; lookup++) {
  98                 np = of_find_compatible_node(NULL, NULL, lookup->compatible);
  99                 if (np) {
 100                         lookup->name = (char *)np->name;
 101                         if (lookup->phys_addr) {
 102                                 of_node_put(np);
 103                                 continue;
 104                         }
 105                         if (!of_address_to_resource(np, 0, &res))
 106                                 lookup->phys_addr = res.start;
 107                         of_node_put(np);
 108                 }
 109         }
 110
 111         of_node_put(root);
 112
 113         return 0;
 114 }
 115
 116 static int __init plat_of_setup(void)
 117 {
 118         if (!of_have_populated_dt())
 119                 panic("Device tree not present");
 120
 121         pic32_of_prepare_platform_data(pic32_auxdata_lookup);
 122         if (of_platform_default_populate(NULL, pic32_auxdata_lookup, NULL))
 123                 panic("Failed to populate DT");
 124
 125         return 0;
 126 }
 127 arch_initcall(plat_of_setup);