1 /* 2 * Cortina CS4315/CS4340 10G PHY drivers 3 * 4 * SPDX-License-Identifier: GPL-2.0+ 5 * 6 * Copyright 2014 Freescale Semiconductor, Inc. 7 * 8 */ 9 10 #include <config.h> 11 #include <common.h> 12 #include <malloc.h> 13 #include <linux/ctype.h> 14 #include <linux/string.h> 15 #include <linux/err.h> 16 #include <phy.h> 17 #include <cortina.h> 18 #ifdef CONFIG_SYS_CORTINA_FW_IN_NAND 19 #include <nand.h> 20 #elif defined(CONFIG_SYS_CORTINA_FW_IN_SPIFLASH) 21 #include <spi_flash.h> 22 #elif defined(CONFIG_SYS_CORTINA_FW_IN_MMC) 23 #include <mmc.h> 24 #endif 25 26 #ifndef CONFIG_PHYLIB_10G 27 #error The Cortina PHY needs 10G support 28 #endif 29 30 struct cortina_reg_config cortina_reg_cfg[] = { 31 /* CS4315_enable_sr_mode */ 32 {VILLA_GLOBAL_MSEQCLKCTRL, 0x8004}, 33 {VILLA_MSEQ_OPTIONS, 0xf}, 34 {VILLA_MSEQ_PC, 0x0}, 35 {VILLA_MSEQ_BANKSELECT, 0x4}, 36 {VILLA_LINE_SDS_COMMON_SRX0_RX_CPA, 0x55}, 37 {VILLA_LINE_SDS_COMMON_SRX0_RX_LOOP_FILTER, 0x30}, 38 {VILLA_DSP_SDS_SERDES_SRX_DFE0_SELECT, 0x1}, 39 {VILLA_DSP_SDS_DSP_COEF_DFE0_SELECT, 0x2}, 40 {VILLA_LINE_SDS_COMMON_SRX0_RX_CPB, 0x2003}, 41 {VILLA_DSP_SDS_SERDES_SRX_FFE_DELAY_CTRL, 0xF047}, 42 {VILLA_MSEQ_ENABLE_MSB, 0x0000}, 43 {VILLA_MSEQ_SPARE21_LSB, 0x6}, 44 {VILLA_MSEQ_RESET_COUNT_LSB, 0x0}, 45 {VILLA_MSEQ_SPARE12_MSB, 0x0000}, 46 /* 47 * to invert the receiver path, uncomment the next line 48 * write (VILLA_MSEQ_SPARE12_MSB, 0x4000) 49 * 50 * SPARE2_LSB is used to configure the device while in sr mode to 51 * enable power savings and to use the optical module LOS signal. 52 * in power savings mode, the internal prbs checker can not be used. 53 * if the optical module LOS signal is used as an input to the micro 54 * code, then the micro code will wait until the optical module 55 * LOS = 0 before turning on the adaptive equalizer. 56 * Setting SPARE2_LSB bit 0 to 1 places the devie in power savings mode 57 * while setting bit 0 to 0 disables power savings mode. 58 * Setting SPARE2_LSB bit 2 to 0 configures the device to use the 59 * optical module LOS signal while setting bit 2 to 1 configures the 60 * device so that it will ignore the optical module LOS SPARE2_LSB = 0 61 */ 62 63 /* enable power savings, ignore optical module LOS */ 64 {VILLA_MSEQ_SPARE2_LSB, 0x5}, 65 66 {VILLA_MSEQ_SPARE7_LSB, 0x1e}, 67 {VILLA_MSEQ_BANKSELECT, 0x4}, 68 {VILLA_MSEQ_SPARE9_LSB, 0x2}, 69 {VILLA_MSEQ_SPARE3_LSB, 0x0F53}, 70 {VILLA_MSEQ_SPARE3_MSB, 0x2006}, 71 {VILLA_MSEQ_SPARE8_LSB, 0x3FF7}, 72 {VILLA_MSEQ_SPARE8_MSB, 0x0A46}, 73 {VILLA_MSEQ_COEF8_FFE0_LSB, 0xD500}, 74 {VILLA_MSEQ_COEF8_FFE1_LSB, 0x0200}, 75 {VILLA_MSEQ_COEF8_FFE2_LSB, 0xBA00}, 76 {VILLA_MSEQ_COEF8_FFE3_LSB, 0x0100}, 77 {VILLA_MSEQ_COEF8_FFE4_LSB, 0x0300}, 78 {VILLA_MSEQ_COEF8_FFE5_LSB, 0x0300}, 79 {VILLA_MSEQ_COEF8_DFE0_LSB, 0x0700}, 80 {VILLA_MSEQ_COEF8_DFE0N_LSB, 0x0E00}, 81 {VILLA_MSEQ_COEF8_DFE1_LSB, 0x0B00}, 82 {VILLA_DSP_SDS_DSP_COEF_LARGE_LEAK, 0x2}, 83 {VILLA_DSP_SDS_SERDES_SRX_DAC_ENABLEB_LSB, 0xD000}, 84 {VILLA_MSEQ_POWER_DOWN_LSB, 0xFFFF}, 85 {VILLA_MSEQ_POWER_DOWN_MSB, 0x0}, 86 {VILLA_MSEQ_CAL_RX_SLICER, 0x80}, 87 {VILLA_DSP_SDS_SERDES_SRX_DAC_BIAS_SELECT1_MSB, 0x3f}, 88 {VILLA_GLOBAL_MSEQCLKCTRL, 0x4}, 89 {VILLA_MSEQ_OPTIONS, 0x7}, 90 91 /* set up min value for ffe1 */ 92 {VILLA_MSEQ_COEF_INIT_SEL, 0x2}, 93 {VILLA_DSP_SDS_DSP_PRECODEDINITFFE21, 0x41}, 94 95 /* CS4315_sr_rx_pre_eq_set_4in */ 96 {VILLA_GLOBAL_MSEQCLKCTRL, 0x8004}, 97 {VILLA_MSEQ_OPTIONS, 0xf}, 98 {VILLA_MSEQ_BANKSELECT, 0x4}, 99 {VILLA_MSEQ_PC, 0x0}, 100 101 /* for lengths from 3.5 to 4.5inches */ 102 {VILLA_MSEQ_SERDES_PARAM_LSB, 0x0306}, 103 {VILLA_MSEQ_SPARE25_LSB, 0x0306}, 104 {VILLA_MSEQ_SPARE21_LSB, 0x2}, 105 {VILLA_MSEQ_SPARE23_LSB, 0x2}, 106 {VILLA_MSEQ_CAL_RX_DFE_EQ, 0x0}, 107 108 {VILLA_GLOBAL_MSEQCLKCTRL, 0x4}, 109 {VILLA_MSEQ_OPTIONS, 0x7}, 110 111 /* CS4315_rx_drive_4inch */ 112 /* for length 4inches */ 113 {VILLA_GLOBAL_VILLA2_COMPATIBLE, 0x0000}, 114 {VILLA_HOST_SDS_COMMON_STX0_TX_OUTPUT_CTRLA, 0x3023}, 115 {VILLA_LINE_SDS_COMMON_STX0_TX_OUTPUT_CTRLB, 0xc01E}, 116 117 /* CS4315_tx_drive_4inch */ 118 /* for length 4inches */ 119 {VILLA_GLOBAL_VILLA2_COMPATIBLE, 0x0000}, 120 {VILLA_LINE_SDS_COMMON_STX0_TX_OUTPUT_CTRLA, 0x3023}, 121 {VILLA_LINE_SDS_COMMON_STX0_TX_OUTPUT_CTRLB, 0xc01E}, 122 }; 123 124 void cs4340_upload_firmware(struct phy_device *phydev) 125 { 126 char line_temp[0x50] = {0}; 127 char reg_addr[0x50] = {0}; 128 char reg_data[0x50] = {0}; 129 int i, line_cnt = 0, column_cnt = 0; 130 struct cortina_reg_config fw_temp; 131 char *addr = NULL; 132 133 #if defined(CONFIG_SYS_CORTINA_FW_IN_NOR) || \ 134 defined(CONFIG_SYS_CORTINA_FW_IN_REMOTE) 135 136 addr = (char *)CONFIG_CORTINA_FW_ADDR; 137 #elif defined(CONFIG_SYS_CORTINA_FW_IN_NAND) 138 int ret; 139 size_t fw_length = CONFIG_CORTINA_FW_LENGTH; 140 141 addr = malloc(CONFIG_CORTINA_FW_LENGTH); 142 ret = nand_read(&nand_info[0], (loff_t)CONFIG_CORTINA_FW_ADDR, 143 &fw_length, (u_char *)addr); 144 if (ret == -EUCLEAN) { 145 printf("NAND read of Cortina firmware at 0x%x failed %d\n", 146 CONFIG_CORTINA_FW_ADDR, ret); 147 } 148 #elif defined(CONFIG_SYS_CORTINA_FW_IN_SPIFLASH) 149 int ret; 150 struct spi_flash *ucode_flash; 151 152 addr = malloc(CONFIG_CORTINA_FW_LENGTH); 153 ucode_flash = spi_flash_probe(CONFIG_ENV_SPI_BUS, CONFIG_ENV_SPI_CS, 154 CONFIG_ENV_SPI_MAX_HZ, CONFIG_ENV_SPI_MODE); 155 if (!ucode_flash) { 156 puts("SF: probe for Cortina ucode failed\n"); 157 } else { 158 ret = spi_flash_read(ucode_flash, CONFIG_CORTINA_FW_ADDR, 159 CONFIG_CORTINA_FW_LENGTH, addr); 160 if (ret) 161 puts("SF: read for Cortina ucode failed\n"); 162 spi_flash_free(ucode_flash); 163 } 164 #elif defined(CONFIG_SYS_CORTINA_FW_IN_MMC) 165 int dev = CONFIG_SYS_MMC_ENV_DEV; 166 u32 cnt = CONFIG_CORTINA_FW_LENGTH / 512; 167 u32 blk = CONFIG_CORTINA_FW_ADDR / 512; 168 struct mmc *mmc = find_mmc_device(CONFIG_SYS_MMC_ENV_DEV); 169 170 if (!mmc) { 171 puts("Failed to find MMC device for Cortina ucode\n"); 172 } else { 173 addr = malloc(CONFIG_CORTINA_FW_LENGTH); 174 printf("MMC read: dev # %u, block # %u, count %u ...\n", 175 dev, blk, cnt); 176 mmc_init(mmc); 177 (void)mmc->block_dev.block_read(&mmc->block_dev, blk, cnt, 178 addr); 179 /* flush cache after read */ 180 flush_cache((ulong)addr, cnt * 512); 181 } 182 #endif 183 184 while (*addr != 'Q') { 185 i = 0; 186 187 while (*addr != 0x0a) { 188 line_temp[i++] = *addr++; 189 if (0x50 < i) { 190 printf("Not found Cortina PHY ucode at 0x%p\n", 191 (char *)CONFIG_CORTINA_FW_ADDR); 192 return; 193 } 194 } 195 196 addr++; /* skip '\n' */ 197 line_cnt++; 198 column_cnt = i; 199 line_temp[column_cnt] = '\0'; 200 201 if (CONFIG_CORTINA_FW_LENGTH < line_cnt) 202 return; 203 204 for (i = 0; i < column_cnt; i++) { 205 if (isspace(line_temp[i++])) 206 break; 207 } 208 209 memcpy(reg_addr, line_temp, i); 210 memcpy(reg_data, &line_temp[i], column_cnt - i); 211 strim(reg_addr); 212 strim(reg_data); 213 fw_temp.reg_addr = (simple_strtoul(reg_addr, NULL, 0)) & 0xffff; 214 fw_temp.reg_value = (simple_strtoul(reg_data, NULL, 0)) & 215 0xffff; 216 phy_write(phydev, 0x00, fw_temp.reg_addr, fw_temp.reg_value); 217 } 218 } 219 220 int cs4340_phy_init(struct phy_device *phydev) 221 { 222 int timeout = 100; /* 100ms */ 223 int reg_value; 224 225 /* step1: BIST test */ 226 phy_write(phydev, 0x00, VILLA_GLOBAL_MSEQCLKCTRL, 0x0004); 227 phy_write(phydev, 0x00, VILLA_GLOBAL_LINE_SOFT_RESET, 0x0000); 228 phy_write(phydev, 0x00, VILLA_GLOBAL_BIST_CONTROL, 0x0001); 229 while (--timeout) { 230 reg_value = phy_read(phydev, 0x00, VILLA_GLOBAL_BIST_STATUS); 231 if (reg_value & mseq_edc_bist_done) { 232 if (0 == (reg_value & mseq_edc_bist_fail)) 233 break; 234 } 235 udelay(1000); 236 } 237 238 if (!timeout) { 239 printf("%s BIST mseq_edc_bist_done timeout!\n", __func__); 240 return -1; 241 } 242 243 /* setp2: upload ucode */ 244 cs4340_upload_firmware(phydev); 245 reg_value = phy_read(phydev, 0x00, VILLA_GLOBAL_DWNLD_CHECKSUM_STATUS); 246 if (reg_value) { 247 debug("%s checksum status failed.\n", __func__); 248 return -1; 249 } 250 251 return 0; 252 } 253 254 int cs4340_config(struct phy_device *phydev) 255 { 256 cs4340_phy_init(phydev); 257 return 0; 258 } 259 260 int cs4340_startup(struct phy_device *phydev) 261 { 262 phydev->link = 1; 263 264 /* For now just lie and say it's 10G all the time */ 265 phydev->speed = SPEED_10000; 266 phydev->duplex = DUPLEX_FULL; 267 return 0; 268 } 269 270 struct phy_driver cs4340_driver = { 271 .name = "Cortina CS4315/CS4340", 272 .uid = PHY_UID_CS4340, 273 .mask = 0xfffffff0, 274 .features = PHY_10G_FEATURES, 275 .mmds = (MDIO_DEVS_PMAPMD | MDIO_DEVS_PCS | 276 MDIO_DEVS_PHYXS | MDIO_DEVS_AN | 277 MDIO_DEVS_VEND1 | MDIO_DEVS_VEND2), 278 .config = &cs4340_config, 279 .startup = &cs4340_startup, 280 .shutdown = &gen10g_shutdown, 281 }; 282 283 int phy_cortina_init(void) 284 { 285 phy_register(&cs4340_driver); 286 return 0; 287 } 288 289 int get_phy_id(struct mii_dev *bus, int addr, int devad, u32 *phy_id) 290 { 291 int phy_reg; 292 bool is_cortina_phy = false; 293 294 switch (addr) { 295 #ifdef CORTINA_PHY_ADDR1 296 case CORTINA_PHY_ADDR1: 297 #endif 298 #ifdef CORTINA_PHY_ADDR2 299 case CORTINA_PHY_ADDR2: 300 #endif 301 #ifdef CORTINA_PHY_ADDR3 302 case CORTINA_PHY_ADDR3: 303 #endif 304 #ifdef CORTINA_PHY_ADDR4 305 case CORTINA_PHY_ADDR4: 306 #endif 307 is_cortina_phy = true; 308 break; 309 default: 310 break; 311 } 312 313 /* Cortina PHY has non-standard offset of PHY ID registers */ 314 if (is_cortina_phy) 315 phy_reg = bus->read(bus, addr, 0, VILLA_GLOBAL_CHIP_ID_LSB); 316 else 317 phy_reg = bus->read(bus, addr, devad, MII_PHYSID1); 318 319 if (phy_reg < 0) 320 return -EIO; 321 322 *phy_id = (phy_reg & 0xffff) << 16; 323 if (is_cortina_phy) 324 phy_reg = bus->read(bus, addr, 0, VILLA_GLOBAL_CHIP_ID_MSB); 325 else 326 phy_reg = bus->read(bus, addr, devad, MII_PHYSID2); 327 328 if (phy_reg < 0) 329 return -EIO; 330 331 *phy_id |= (phy_reg & 0xffff); 332 333 return 0; 334 } 335