2 * Cortina CS4315/CS4340 10G PHY drivers
4 * SPDX-License-Identifier: GPL-2.0+
6 * Copyright 2014 Freescale Semiconductor, Inc.
13 #include <linux/ctype.h>
14 #include <linux/string.h>
15 #include <linux/err.h>
18 #ifdef CONFIG_SYS_CORTINA_FW_IN_NAND
20 #elif defined(CONFIG_SYS_CORTINA_FW_IN_SPIFLASH)
21 #include <spi_flash.h>
22 #elif defined(CONFIG_SYS_CORTINA_FW_IN_MMC)
26 #ifndef CONFIG_PHYLIB_10G
27 #error The Cortina PHY needs 10G support
30 struct cortina_reg_config cortina_reg_cfg
[] = {
31 /* CS4315_enable_sr_mode */
32 {VILLA_GLOBAL_MSEQCLKCTRL
, 0x8004},
33 {VILLA_MSEQ_OPTIONS
, 0xf},
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},
47 * to invert the receiver path, uncomment the next line
48 * write (VILLA_MSEQ_SPARE12_MSB, 0x4000)
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
63 /* enable power savings, ignore optical module LOS */
64 {VILLA_MSEQ_SPARE2_LSB
, 0x5},
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},
91 /* set up min value for ffe1 */
92 {VILLA_MSEQ_COEF_INIT_SEL
, 0x2},
93 {VILLA_DSP_SDS_DSP_PRECODEDINITFFE21
, 0x41},
95 /* CS4315_sr_rx_pre_eq_set_4in */
96 {VILLA_GLOBAL_MSEQCLKCTRL
, 0x8004},
97 {VILLA_MSEQ_OPTIONS
, 0xf},
98 {VILLA_MSEQ_BANKSELECT
, 0x4},
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},
108 {VILLA_GLOBAL_MSEQCLKCTRL
, 0x4},
109 {VILLA_MSEQ_OPTIONS
, 0x7},
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},
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},
124 void cs4340_upload_firmware(struct phy_device
*phydev
)
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
;
133 #if defined(CONFIG_SYS_CORTINA_FW_IN_NOR) || \
134 defined(CONFIG_SYS_CORTINA_FW_IN_REMOTE)
136 addr
= (char *)CONFIG_CORTINA_FW_ADDR
;
137 #elif defined(CONFIG_SYS_CORTINA_FW_IN_NAND)
139 size_t fw_length
= CONFIG_CORTINA_FW_LENGTH
;
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
);
148 #elif defined(CONFIG_SYS_CORTINA_FW_IN_SPIFLASH)
150 struct spi_flash
*ucode_flash
;
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
);
156 puts("SF: probe for Cortina ucode failed\n");
158 ret
= spi_flash_read(ucode_flash
, CONFIG_CORTINA_FW_ADDR
,
159 CONFIG_CORTINA_FW_LENGTH
, addr
);
161 puts("SF: read for Cortina ucode failed\n");
162 spi_flash_free(ucode_flash
);
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
);
171 puts("Failed to find MMC device for Cortina ucode\n");
173 addr
= malloc(CONFIG_CORTINA_FW_LENGTH
);
174 printf("MMC read: dev # %u, block # %u, count %u ...\n",
177 (void)mmc
->block_dev
.block_read(dev
, blk
, cnt
, addr
);
178 /* flush cache after read */
179 flush_cache((ulong
)addr
, cnt
* 512);
183 while (*addr
!= 'Q') {
186 while (*addr
!= 0x0a) {
187 line_temp
[i
++] = *addr
++;
189 printf("Not found Cortina PHY ucode at 0x%p\n",
190 (char *)CONFIG_CORTINA_FW_ADDR
);
195 addr
++; /* skip '\n' */
198 line_temp
[column_cnt
] = '\0';
200 if (CONFIG_CORTINA_FW_LENGTH
< line_cnt
)
203 for (i
= 0; i
< column_cnt
; i
++) {
204 if (isspace(line_temp
[i
++]))
208 memcpy(reg_addr
, line_temp
, i
);
209 memcpy(reg_data
, &line_temp
[i
], column_cnt
- i
);
212 fw_temp
.reg_addr
= (simple_strtoul(reg_addr
, NULL
, 0)) & 0xffff;
213 fw_temp
.reg_value
= (simple_strtoul(reg_data
, NULL
, 0)) &
215 phy_write(phydev
, 0x00, fw_temp
.reg_addr
, fw_temp
.reg_value
);
219 int cs4340_phy_init(struct phy_device
*phydev
)
221 int timeout
= 100; /* 100ms */
224 /* step1: BIST test */
225 phy_write(phydev
, 0x00, VILLA_GLOBAL_MSEQCLKCTRL
, 0x0004);
226 phy_write(phydev
, 0x00, VILLA_GLOBAL_LINE_SOFT_RESET
, 0x0000);
227 phy_write(phydev
, 0x00, VILLA_GLOBAL_BIST_CONTROL
, 0x0001);
229 reg_value
= phy_read(phydev
, 0x00, VILLA_GLOBAL_BIST_STATUS
);
230 if (reg_value
& mseq_edc_bist_done
) {
231 if (0 == (reg_value
& mseq_edc_bist_fail
))
238 printf("%s BIST mseq_edc_bist_done timeout!\n", __func__
);
242 /* setp2: upload ucode */
243 cs4340_upload_firmware(phydev
);
244 reg_value
= phy_read(phydev
, 0x00, VILLA_GLOBAL_DWNLD_CHECKSUM_STATUS
);
246 debug("%s checksum status failed.\n", __func__
);
253 int cs4340_config(struct phy_device
*phydev
)
255 cs4340_phy_init(phydev
);
259 int cs4340_startup(struct phy_device
*phydev
)
263 /* For now just lie and say it's 10G all the time */
264 phydev
->speed
= SPEED_10000
;
265 phydev
->duplex
= DUPLEX_FULL
;
269 struct phy_driver cs4340_driver
= {
270 .name
= "Cortina CS4315/CS4340",
271 .uid
= PHY_UID_CS4340
,
273 .features
= PHY_10G_FEATURES
,
274 .mmds
= (MDIO_DEVS_PMAPMD
| MDIO_DEVS_PCS
|
275 MDIO_DEVS_PHYXS
| MDIO_DEVS_AN
|
276 MDIO_DEVS_VEND1
| MDIO_DEVS_VEND2
),
277 .config
= &cs4340_config
,
278 .startup
= &cs4340_startup
,
279 .shutdown
= &gen10g_shutdown
,
282 int phy_cortina_init(void)
284 phy_register(&cs4340_driver
);
288 int get_phy_id(struct mii_dev
*bus
, int addr
, int devad
, u32
*phy_id
)
291 bool is_cortina_phy
= false;
294 #ifdef CORTINA_PHY_ADDR1
295 case CORTINA_PHY_ADDR1
:
297 #ifdef CORTINA_PHY_ADDR2
298 case CORTINA_PHY_ADDR2
:
300 #ifdef CORTINA_PHY_ADDR3
301 case CORTINA_PHY_ADDR3
:
303 #ifdef CORTINA_PHY_ADDR4
304 case CORTINA_PHY_ADDR4
:
306 is_cortina_phy
= true;
312 /* Cortina PHY has non-standard offset of PHY ID registers */
314 phy_reg
= bus
->read(bus
, addr
, 0, VILLA_GLOBAL_CHIP_ID_LSB
);
316 phy_reg
= bus
->read(bus
, addr
, devad
, MII_PHYSID1
);
321 *phy_id
= (phy_reg
& 0xffff) << 16;
323 phy_reg
= bus
->read(bus
, addr
, 0, VILLA_GLOBAL_CHIP_ID_MSB
);
325 phy_reg
= bus
->read(bus
, addr
, devad
, MII_PHYSID2
);
330 *phy_id
|= (phy_reg
& 0xffff);