blob: 70399307bcbda1e067230f00af6ba859a98c7ac0 [file] [log] [blame]
Caleb Connolly2983ae82024-04-03 14:07:45 +02001// SPDX-License-Identifier: GPL-2.0+
2/*
3 * OF_LIVE devicetree fixup.
4 *
5 * This file implements runtime fixups for Qualcomm DT to improve
6 * compatibility with U-Boot. This includes adjusting the USB nodes
7 * to only use USB high-speed, as well as remapping volume buttons
8 * to behave as up/down for navigating U-Boot.
9 *
10 * We use OF_LIVE for this rather than early FDT fixup for a couple
11 * of reasons: it has a much nicer API, is most likely more efficient,
12 * and our changes are only applied to U-Boot. This allows us to use a
13 * DT designed for Linux, run U-Boot with a modified version, and then
14 * boot Linux with the original FDT.
15 *
16 * Copyright (c) 2024 Linaro Ltd.
17 * Author: Caleb Connolly <caleb.connolly@linaro.org>
18 */
19
Caleb Connolly965a98d2024-04-18 18:25:49 +010020#define pr_fmt(fmt) "of_fixup: " fmt
21
Caleb Connolly2983ae82024-04-03 14:07:45 +020022#include <dt-bindings/input/linux-event-codes.h>
23#include <dm/of_access.h>
24#include <dm/of.h>
Caleb Connollyc60b3f42025-04-11 14:47:39 +020025#include <event.h>
Caleb Connolly2983ae82024-04-03 14:07:45 +020026#include <fdt_support.h>
27#include <linux/errno.h>
Caleb Connolly4f80e282024-04-03 14:07:46 +020028#include <stdlib.h>
Caleb Connolly2983ae82024-04-03 14:07:45 +020029#include <time.h>
30
31/* U-Boot only supports USB high-speed mode on Qualcomm platforms with DWC3
32 * USB controllers. Rather than requiring source level DT changes, we fix up
33 * DT here. This improves compatibility with upstream DT and simplifies the
34 * porting process for new devices.
35 */
Caleb Connollyc60b3f42025-04-11 14:47:39 +020036static int fixup_qcom_dwc3(struct device_node *root, struct device_node *glue_np)
Caleb Connolly2983ae82024-04-03 14:07:45 +020037{
38 struct device_node *dwc3;
39 int ret, len, hsphy_idx = 1;
40 const __be32 *phandles;
41 const char *second_phy_name;
42
43 debug("Fixing up %s\n", glue_np->name);
44
45 /* Tell the glue driver to configure the wrapper for high-speed only operation */
46 ret = of_write_prop(glue_np, "qcom,select-utmi-as-pipe-clk", 0, NULL);
47 if (ret) {
48 log_err("Failed to add property 'qcom,select-utmi-as-pipe-clk': %d\n", ret);
49 return ret;
50 }
51
52 /* Find the DWC3 node itself */
53 dwc3 = of_find_compatible_node(glue_np, NULL, "snps,dwc3");
54 if (!dwc3) {
55 log_err("Failed to find dwc3 node\n");
56 return -ENOENT;
57 }
58
59 phandles = of_get_property(dwc3, "phys", &len);
60 len /= sizeof(*phandles);
61 if (len == 1) {
62 log_debug("Only one phy, not a superspeed controller\n");
63 return 0;
64 }
65
66 /* Figure out if the superspeed phy is present and if so then which phy is it? */
67 ret = of_property_read_string_index(dwc3, "phy-names", 1, &second_phy_name);
68 if (ret == -ENODATA) {
69 log_debug("Only one phy, not a super-speed controller\n");
70 return 0;
71 } else if (ret) {
72 log_err("Failed to read second phy name: %d\n", ret);
73 return ret;
74 }
75
76 if (!strncmp("usb3-phy", second_phy_name, strlen("usb3-phy"))) {
77 log_debug("Second phy isn't superspeed (is '%s') assuming first phy is SS\n",
78 second_phy_name);
79 hsphy_idx = 0;
80 }
81
82 /* Overwrite the "phys" property to only contain the high-speed phy */
83 ret = of_write_prop(dwc3, "phys", sizeof(*phandles), phandles + hsphy_idx);
84 if (ret) {
85 log_err("Failed to overwrite 'phys' property: %d\n", ret);
86 return ret;
87 }
88
89 /* Overwrite "phy-names" to only contain a single entry */
Rui Miguel Silva3e5447f2025-02-27 09:45:49 +000090 ret = of_write_prop(dwc3, "phy-names", strlen("usb2-phy") + 1, "usb2-phy");
Caleb Connolly2983ae82024-04-03 14:07:45 +020091 if (ret) {
92 log_err("Failed to overwrite 'phy-names' property: %d\n", ret);
93 return ret;
94 }
95
Rui Miguel Silva3e5447f2025-02-27 09:45:49 +000096 ret = of_write_prop(dwc3, "maximum-speed", strlen("high-speed") + 1, "high-speed");
Caleb Connolly2983ae82024-04-03 14:07:45 +020097 if (ret) {
98 log_err("Failed to set 'maximum-speed' property: %d\n", ret);
99 return ret;
100 }
101
102 return 0;
103}
104
Caleb Connollyc60b3f42025-04-11 14:47:39 +0200105static void fixup_usb_nodes(struct device_node *root)
Caleb Connolly2983ae82024-04-03 14:07:45 +0200106{
Caleb Connollyc60b3f42025-04-11 14:47:39 +0200107 struct device_node *glue_np = root;
Caleb Connolly2983ae82024-04-03 14:07:45 +0200108 int ret;
109
110 while ((glue_np = of_find_compatible_node(glue_np, NULL, "qcom,dwc3"))) {
111 ret = fixup_qcom_dwc3(glue_np);
112 if (ret)
113 log_warning("Failed to fixup node %s: %d\n", glue_np->name, ret);
114 }
115}
116
Caleb Connolly4f80e282024-04-03 14:07:46 +0200117/* Remove all references to the rpmhpd device */
Caleb Connollyc60b3f42025-04-11 14:47:39 +0200118static void fixup_power_domains(struct device_node *root)
Caleb Connolly4f80e282024-04-03 14:07:46 +0200119{
120 struct device_node *pd = NULL, *np = NULL;
121 struct property *prop;
122 const __be32 *val;
123
124 /* All Qualcomm platforms name the rpm(h)pd "power-controller" */
Caleb Connollyc60b3f42025-04-11 14:47:39 +0200125 for_each_of_allnodes_from(root, pd) {
Caleb Connolly4f80e282024-04-03 14:07:46 +0200126 if (pd->name && !strcmp("power-controller", pd->name))
127 break;
128 }
129
130 /* Sanity check that this is indeed a power domain controller */
131 if (!of_find_property(pd, "#power-domain-cells", NULL)) {
132 log_err("Found power-controller but it doesn't have #power-domain-cells\n");
133 return;
134 }
135
136 /* Remove all references to the power domain controller */
Caleb Connollyc60b3f42025-04-11 14:47:39 +0200137 for_each_of_allnodes_from(root, np) {
Caleb Connolly4f80e282024-04-03 14:07:46 +0200138 if (!(prop = of_find_property(np, "power-domains", NULL)))
139 continue;
140
141 val = prop->value;
142 if (val[0] == cpu_to_fdt32(pd->phandle))
143 of_remove_property(np, prop);
144 }
145}
146
Caleb Connolly2983ae82024-04-03 14:07:45 +0200147#define time_call(func, ...) \
148 do { \
149 u64 start = timer_get_us(); \
150 func(__VA_ARGS__); \
151 debug(#func " took %lluus\n", timer_get_us() - start); \
152 } while (0)
153
Caleb Connollyc60b3f42025-04-11 14:47:39 +0200154static int qcom_of_fixup_nodes(void * __maybe_unused ctx, struct event *event)
Caleb Connolly2983ae82024-04-03 14:07:45 +0200155{
Caleb Connollyc60b3f42025-04-11 14:47:39 +0200156 struct device_node *root = event->data.of_live_built.root;
157
158 time_call(fixup_usb_nodes, root);
159 time_call(fixup_power_domains, root);
160
161 return 0;
Caleb Connolly2983ae82024-04-03 14:07:45 +0200162}
Caleb Connolly965a98d2024-04-18 18:25:49 +0100163
Caleb Connollyc60b3f42025-04-11 14:47:39 +0200164EVENT_SPY_FULL(EVT_OF_LIVE_BUILT, qcom_of_fixup_nodes);
165
Caleb Connolly965a98d2024-04-18 18:25:49 +0100166int ft_board_setup(void *blob, struct bd_info __maybe_unused *bd)
167{
168 struct fdt_header *fdt = blob;
169 int node;
170
Caleb Connollyb788d022025-03-31 12:43:18 +0200171 /* On RB1/2 we need to fix-up the dr_mode */
172 if (!fdt_node_check_compatible(fdt, 0, "qcom,qrb4210-rb2") ||
173 !fdt_node_check_compatible(fdt, 0, "qcom,qrb2210-rb1")) {
174 fdt_for_each_node_by_compatible(node, blob, 0, "snps,dwc3") {
175 log_debug("%s: Setting 'dr_mode' to OTG\n", fdt_get_name(blob, node, NULL));
176 fdt_setprop_string(fdt, node, "dr_mode", "otg");
177 break;
178 }
Caleb Connolly965a98d2024-04-18 18:25:49 +0100179 }
180
181 return 0;
182}