1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright (C) 2015-2016 Marvell International Ltd.
4  *
5  * Copyright (C) 2016 Stefan Roese <sr@denx.de>
6  */
7 
8 #include <common.h>
9 #include <dm.h>
10 #include <fdtdec.h>
11 #include <linux/errno.h>
12 #include <asm/io.h>
13 
14 #include "comphy_core.h"
15 
16 #define COMPHY_MAX_CHIP 4
17 
18 DECLARE_GLOBAL_DATA_PTR;
19 
20 static const char *get_speed_string(u32 speed)
21 {
22 	static const char * const speed_strings[] = {
23 		"1.25 Gbps", "1.5 Gbps", "2.5 Gbps",
24 		"3.0 Gbps", "3.125 Gbps", "5 Gbps", "6 Gbps",
25 		"6.25 Gbps", "10.31 Gbps"
26 	};
27 
28 	if (speed < 0 || speed > PHY_SPEED_MAX)
29 		return "invalid";
30 
31 	return speed_strings[speed];
32 }
33 
34 static const char *get_type_string(u32 type)
35 {
36 	static const char * const type_strings[] = {
37 		"UNCONNECTED", "PEX0", "PEX1", "PEX2", "PEX3",
38 		"SATA0", "SATA1", "SATA2", "SATA3", "SGMII0",
39 		"SGMII1", "SGMII2", "SGMII3", "QSGMII",
40 		"USB3_HOST0", "USB3_HOST1", "USB3_DEVICE",
41 		"XAUI0", "XAUI1", "XAUI2", "XAUI3",
42 		"RXAUI0", "RXAUI1", "SFI", "IGNORE"
43 	};
44 
45 	if (type < 0 || type > PHY_TYPE_MAX)
46 		return "invalid";
47 
48 	return type_strings[type];
49 }
50 
51 void comphy_print(struct chip_serdes_phy_config *chip_cfg,
52 		  struct comphy_map *comphy_map_data)
53 {
54 	u32 lane;
55 
56 	for (lane = 0; lane < chip_cfg->comphy_lanes_count;
57 	     lane++, comphy_map_data++) {
58 		if (comphy_map_data->speed == PHY_SPEED_INVALID) {
59 			printf("Comphy-%d: %-13s\n", lane,
60 			       get_type_string(comphy_map_data->type));
61 		} else {
62 			printf("Comphy-%d: %-13s %-10s\n", lane,
63 			       get_type_string(comphy_map_data->type),
64 			       get_speed_string(comphy_map_data->speed));
65 		}
66 	}
67 }
68 
69 __weak int comphy_update_map(struct comphy_map *serdes_map, int count)
70 {
71 	return 0;
72 }
73 
74 static int comphy_probe(struct udevice *dev)
75 {
76 	const void *blob = gd->fdt_blob;
77 	int node = dev_of_offset(dev);
78 	struct chip_serdes_phy_config *chip_cfg = dev_get_priv(dev);
79 	struct comphy_map comphy_map_data[MAX_LANE_OPTIONS];
80 	int subnode;
81 	int lane;
82 	int last_idx = 0;
83 	static int current_idx;
84 	int res;
85 
86 	/* Save base addresses for later use */
87 	chip_cfg->comphy_base_addr = (void *)devfdt_get_addr_index(dev, 0);
88 	if (IS_ERR(chip_cfg->comphy_base_addr))
89 		return PTR_ERR(chip_cfg->comphy_base_addr);
90 
91 	chip_cfg->hpipe3_base_addr = (void *)devfdt_get_addr_index(dev, 1);
92 	if (IS_ERR(chip_cfg->hpipe3_base_addr))
93 		return PTR_ERR(chip_cfg->hpipe3_base_addr);
94 
95 	chip_cfg->comphy_lanes_count = fdtdec_get_int(blob, node,
96 						      "max-lanes", 0);
97 	if (chip_cfg->comphy_lanes_count <= 0) {
98 		dev_err(&dev->dev, "comphy max lanes is wrong\n");
99 		return -EINVAL;
100 	}
101 
102 	chip_cfg->comphy_mux_bitcount = fdtdec_get_int(blob, node,
103 						       "mux-bitcount", 0);
104 	if (chip_cfg->comphy_mux_bitcount <= 0) {
105 		dev_err(&dev->dev, "comphy mux bit count is wrong\n");
106 		return -EINVAL;
107 	}
108 
109 	chip_cfg->comphy_mux_lane_order =
110 		fdtdec_locate_array(blob, node, "mux-lane-order",
111 				    chip_cfg->comphy_lanes_count);
112 
113 	if (device_is_compatible(dev, "marvell,comphy-armada-3700"))
114 		chip_cfg->ptr_comphy_chip_init = comphy_a3700_init;
115 
116 	if (device_is_compatible(dev, "marvell,comphy-cp110"))
117 		chip_cfg->ptr_comphy_chip_init = comphy_cp110_init;
118 
119 	/*
120 	 * Bail out if no chip_init function is defined, e.g. no
121 	 * compatible node is found
122 	 */
123 	if (!chip_cfg->ptr_comphy_chip_init) {
124 		dev_err(&dev->dev, "comphy: No compatible DT node found\n");
125 		return -ENODEV;
126 	}
127 
128 	lane = 0;
129 	fdt_for_each_subnode(subnode, blob, node) {
130 		/* Skip disabled ports */
131 		if (!fdtdec_get_is_enabled(blob, subnode))
132 			continue;
133 
134 		comphy_map_data[lane].speed = fdtdec_get_int(
135 			blob, subnode, "phy-speed", PHY_TYPE_INVALID);
136 		comphy_map_data[lane].type = fdtdec_get_int(
137 			blob, subnode, "phy-type", PHY_SPEED_INVALID);
138 		comphy_map_data[lane].invert = fdtdec_get_int(
139 			blob, subnode, "phy-invert", PHY_POLARITY_NO_INVERT);
140 		comphy_map_data[lane].clk_src = fdtdec_get_bool(blob, subnode,
141 								"clk-src");
142 		comphy_map_data[lane].end_point = fdtdec_get_bool(blob, subnode,
143 								  "end_point");
144 		if (comphy_map_data[lane].type == PHY_TYPE_INVALID) {
145 			printf("no phy type for lane %d, setting lane as unconnected\n",
146 			       lane + 1);
147 		}
148 
149 		lane++;
150 	}
151 
152 	res = comphy_update_map(comphy_map_data, chip_cfg->comphy_lanes_count);
153 	if (res < 0)
154 		return res;
155 
156 	/* Save CP index for MultiCP devices (A8K) */
157 	chip_cfg->cp_index = current_idx++;
158 	/* PHY power UP sequence */
159 	chip_cfg->ptr_comphy_chip_init(chip_cfg, comphy_map_data);
160 	/* PHY print SerDes status */
161 	if (of_machine_is_compatible("marvell,armada8040"))
162 		printf("Comphy chip #%d:\n", chip_cfg->cp_index);
163 	comphy_print(chip_cfg, comphy_map_data);
164 
165 	/*
166 	 * Only run the dedicated PHY init code once, in the last PHY init call
167 	 */
168 	if (of_machine_is_compatible("marvell,armada8040"))
169 		last_idx = 1;
170 
171 	if (chip_cfg->cp_index == last_idx) {
172 		/* Initialize dedicated PHYs (not muxed SerDes lanes) */
173 		comphy_dedicated_phys_init();
174 	}
175 
176 	return 0;
177 }
178 
179 static const struct udevice_id comphy_ids[] = {
180 	{ .compatible = "marvell,mvebu-comphy" },
181 	{ }
182 };
183 
184 U_BOOT_DRIVER(mvebu_comphy) = {
185 	.name	= "mvebu_comphy",
186 	.id	= UCLASS_MISC,
187 	.of_match = comphy_ids,
188 	.probe	= comphy_probe,
189 	.priv_auto_alloc_size = sizeof(struct chip_serdes_phy_config),
190 };
191