blob: dcd09ee7cac3e02287647c9e6df5575651e18e85 [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"))) {
Caleb Connollya3926f82025-04-11 14:47:40 +0200111 if (!of_device_is_available(glue_np))
112 continue;
113 ret = fixup_qcom_dwc3(root, glue_np);
Caleb Connolly2983ae82024-04-03 14:07:45 +0200114 if (ret)
115 log_warning("Failed to fixup node %s: %d\n", glue_np->name, ret);
116 }
117}
118
Caleb Connolly4f80e282024-04-03 14:07:46 +0200119/* Remove all references to the rpmhpd device */
Caleb Connollyc60b3f42025-04-11 14:47:39 +0200120static void fixup_power_domains(struct device_node *root)
Caleb Connolly4f80e282024-04-03 14:07:46 +0200121{
122 struct device_node *pd = NULL, *np = NULL;
123 struct property *prop;
124 const __be32 *val;
125
126 /* All Qualcomm platforms name the rpm(h)pd "power-controller" */
Caleb Connollyc60b3f42025-04-11 14:47:39 +0200127 for_each_of_allnodes_from(root, pd) {
Caleb Connolly4f80e282024-04-03 14:07:46 +0200128 if (pd->name && !strcmp("power-controller", pd->name))
129 break;
130 }
131
132 /* Sanity check that this is indeed a power domain controller */
133 if (!of_find_property(pd, "#power-domain-cells", NULL)) {
134 log_err("Found power-controller but it doesn't have #power-domain-cells\n");
135 return;
136 }
137
138 /* Remove all references to the power domain controller */
Caleb Connollyc60b3f42025-04-11 14:47:39 +0200139 for_each_of_allnodes_from(root, np) {
Caleb Connolly4f80e282024-04-03 14:07:46 +0200140 if (!(prop = of_find_property(np, "power-domains", NULL)))
141 continue;
142
143 val = prop->value;
144 if (val[0] == cpu_to_fdt32(pd->phandle))
145 of_remove_property(np, prop);
146 }
147}
148
Caleb Connolly2983ae82024-04-03 14:07:45 +0200149#define time_call(func, ...) \
150 do { \
151 u64 start = timer_get_us(); \
152 func(__VA_ARGS__); \
153 debug(#func " took %lluus\n", timer_get_us() - start); \
154 } while (0)
155
Caleb Connollyc60b3f42025-04-11 14:47:39 +0200156static int qcom_of_fixup_nodes(void * __maybe_unused ctx, struct event *event)
Caleb Connolly2983ae82024-04-03 14:07:45 +0200157{
Caleb Connollyc60b3f42025-04-11 14:47:39 +0200158 struct device_node *root = event->data.of_live_built.root;
159
160 time_call(fixup_usb_nodes, root);
161 time_call(fixup_power_domains, root);
162
163 return 0;
Caleb Connolly2983ae82024-04-03 14:07:45 +0200164}
Caleb Connolly965a98d2024-04-18 18:25:49 +0100165
Caleb Connollyc60b3f42025-04-11 14:47:39 +0200166EVENT_SPY_FULL(EVT_OF_LIVE_BUILT, qcom_of_fixup_nodes);
167
Caleb Connolly965a98d2024-04-18 18:25:49 +0100168int ft_board_setup(void *blob, struct bd_info __maybe_unused *bd)
169{
170 struct fdt_header *fdt = blob;
171 int node;
172
Caleb Connollyb788d022025-03-31 12:43:18 +0200173 /* On RB1/2 we need to fix-up the dr_mode */
174 if (!fdt_node_check_compatible(fdt, 0, "qcom,qrb4210-rb2") ||
175 !fdt_node_check_compatible(fdt, 0, "qcom,qrb2210-rb1")) {
176 fdt_for_each_node_by_compatible(node, blob, 0, "snps,dwc3") {
177 log_debug("%s: Setting 'dr_mode' to OTG\n", fdt_get_name(blob, node, NULL));
178 fdt_setprop_string(fdt, node, "dr_mode", "otg");
179 break;
180 }
Caleb Connolly965a98d2024-04-18 18:25:49 +0100181 }
182
183 return 0;
184}