1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Copyright 2008 Freescale Semiconductor, Inc.
4 *
5 * (C) Copyright 2000
6 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
7 */
8
9 #include <common.h>
10 #include <linux/libfdt.h>
11 #include <fdt_support.h>
12 #include <fsl_qe.h>
13
14 #ifdef CONFIG_QE
15 DECLARE_GLOBAL_DATA_PTR;
16
17 /*
18 * If a QE firmware has been uploaded, then add the 'firmware' node under
19 * the 'qe' node.
20 */
fdt_fixup_qe_firmware(void * blob)21 void fdt_fixup_qe_firmware(void *blob)
22 {
23 struct qe_firmware_info *qe_fw_info;
24 int node, ret;
25
26 qe_fw_info = qe_get_firmware_info();
27 if (!qe_fw_info)
28 return;
29
30 node = fdt_path_offset(blob, "/qe");
31 if (node < 0)
32 return;
33
34 /* We assume the node doesn't exist yet */
35 node = fdt_add_subnode(blob, node, "firmware");
36 if (node < 0)
37 return;
38
39 ret = fdt_setprop(blob, node, "extended-modes",
40 &qe_fw_info->extended_modes, sizeof(u64));
41 if (ret < 0)
42 goto error;
43
44 ret = fdt_setprop_string(blob, node, "id", qe_fw_info->id);
45 if (ret < 0)
46 goto error;
47
48 ret = fdt_setprop(blob, node, "virtual-traps", qe_fw_info->vtraps,
49 sizeof(qe_fw_info->vtraps));
50 if (ret < 0)
51 goto error;
52
53 return;
54
55 error:
56 fdt_del_node(blob, node);
57 }
58
ft_qe_setup(void * blob)59 void ft_qe_setup(void *blob)
60 {
61 do_fixup_by_prop_u32(blob, "device_type", "qe", 4,
62 "bus-frequency", gd->arch.qe_clk, 1);
63 do_fixup_by_prop_u32(blob, "device_type", "qe", 4,
64 "brg-frequency", gd->arch.brg_clk, 1);
65 do_fixup_by_compat_u32(blob, "fsl,qe",
66 "clock-frequency", gd->arch.qe_clk, 1);
67 do_fixup_by_compat_u32(blob, "fsl,qe",
68 "bus-frequency", gd->arch.qe_clk, 1);
69 do_fixup_by_compat_u32(blob, "fsl,qe",
70 "brg-frequency", gd->arch.brg_clk, 1);
71 do_fixup_by_compat_u32(blob, "fsl,qe-gtm",
72 "clock-frequency", gd->arch.qe_clk / 2, 1);
73 fdt_fixup_qe_firmware(blob);
74 }
75 #endif
76