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