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
get_system_type(void)19 const char *get_system_type(void)
20 {
21 return "PIC32MZDA";
22 }
23
get_fdtaddr(void)24 static ulong get_fdtaddr(void)
25 {
26 ulong ftaddr = 0;
27
28 if (fw_passed_dtb && !fw_arg2 && !fw_arg3)
29 return (ulong)fw_passed_dtb;
30
31 if (__dtb_start < __dtb_end)
32 ftaddr = (ulong)__dtb_start;
33
34 return ftaddr;
35 }
36
plat_mem_setup(void)37 void __init plat_mem_setup(void)
38 {
39 void *dtb;
40
41 dtb = (void *)get_fdtaddr();
42 if (!dtb) {
43 pr_err("pic32: no DTB found.\n");
44 return;
45 }
46
47 /*
48 * Load the builtin device tree. This causes the chosen node to be
49 * parsed resulting in our memory appearing.
50 */
51 __dt_setup_arch(dtb);
52
53 pr_info("Found following command lines\n");
54 pr_info(" boot_command_line: %s\n", boot_command_line);
55 pr_info(" arcs_cmdline : %s\n", arcs_cmdline);
56 #ifdef CONFIG_CMDLINE_BOOL
57 pr_info(" builtin_cmdline : %s\n", CONFIG_CMDLINE);
58 #endif
59 if (dtb != __dtb_start)
60 strlcpy(arcs_cmdline, boot_command_line, COMMAND_LINE_SIZE);
61
62 #ifdef CONFIG_EARLY_PRINTK
63 fw_init_early_console(-1);
64 #endif
65 pic32_config_init();
66 }
67
pic32_init_cmdline(int argc,char * argv[])68 static __init void pic32_init_cmdline(int argc, char *argv[])
69 {
70 unsigned int count = COMMAND_LINE_SIZE - 1;
71 int i;
72 char *dst = &(arcs_cmdline[0]);
73 char *src;
74
75 for (i = 1; i < argc && count; ++i) {
76 src = argv[i];
77 while (*src && count) {
78 *dst++ = *src++;
79 --count;
80 }
81 *dst++ = ' ';
82 }
83 if (i > 1)
84 --dst;
85
86 *dst = 0;
87 }
88
prom_init(void)89 void __init prom_init(void)
90 {
91 pic32_init_cmdline((int)fw_arg0, (char **)fw_arg1);
92 }
93
prom_free_prom_memory(void)94 void __init prom_free_prom_memory(void)
95 {
96 }
97
device_tree_init(void)98 void __init device_tree_init(void)
99 {
100 if (!initial_boot_params)
101 return;
102
103 unflatten_and_copy_device_tree();
104 }
105
106 static struct pic32_sdhci_platform_data sdhci_data = {
107 .setup_dma = pic32_set_sdhci_adma_fifo_threshold,
108 };
109
110 static struct of_dev_auxdata pic32_auxdata_lookup[] __initdata = {
111 OF_DEV_AUXDATA("microchip,pic32mzda-sdhci", 0, "sdhci", &sdhci_data),
112 { /* sentinel */}
113 };
114
pic32_of_prepare_platform_data(struct of_dev_auxdata * lookup)115 static int __init pic32_of_prepare_platform_data(struct of_dev_auxdata *lookup)
116 {
117 struct device_node *root, *np;
118 struct resource res;
119
120 root = of_find_node_by_path("/");
121
122 for (; lookup->compatible; lookup++) {
123 np = of_find_compatible_node(NULL, NULL, lookup->compatible);
124 if (np) {
125 lookup->name = (char *)np->name;
126 if (lookup->phys_addr)
127 continue;
128 if (!of_address_to_resource(np, 0, &res))
129 lookup->phys_addr = res.start;
130 }
131 }
132
133 return 0;
134 }
135
plat_of_setup(void)136 static int __init plat_of_setup(void)
137 {
138 if (!of_have_populated_dt())
139 panic("Device tree not present");
140
141 pic32_of_prepare_platform_data(pic32_auxdata_lookup);
142 if (of_platform_default_populate(NULL, pic32_auxdata_lookup, NULL))
143 panic("Failed to populate DT");
144
145 return 0;
146 }
147 arch_initcall(plat_of_setup);
148