]>
Commit | Line | Data |
---|---|---|
111fd19e RZ |
1 | /* |
2 | * Copyright 2012 Freescale Semiconductor, Inc. | |
b21f87a3 | 3 | * Andy Fleming <afleming@gmail.com> |
111fd19e RZ |
4 | * Roy Zang <tie-fei.zang@freescale.com> |
5 | * | |
1a459660 | 6 | * SPDX-License-Identifier: GPL-2.0+ |
111fd19e RZ |
7 | * Some part is taken from tsec.c |
8 | */ | |
9 | #include <common.h> | |
10 | #include <miiphy.h> | |
11 | #include <phy.h> | |
12 | #include <asm/io.h> | |
cd348efa | 13 | #include <fsl_memac.h> |
111fd19e RZ |
14 | #include <fm_eth.h> |
15 | ||
cd348efa SX |
16 | #ifdef CONFIG_SYS_MEMAC_LITTLE_ENDIAN |
17 | #define memac_out_32(a, v) out_le32(a, v) | |
18 | #define memac_clrbits_32(a, v) clrbits_le32(a, v) | |
19 | #define memac_setbits_32(a, v) setbits_le32(a, v) | |
20 | #else | |
21 | #define memac_out_32(a, v) out_be32(a, v) | |
22 | #define memac_clrbits_32(a, v) clrbits_be32(a, v) | |
23 | #define memac_setbits_32(a, v) setbits_be32(a, v) | |
24 | #endif | |
25 | ||
26 | static u32 memac_in_32(u32 *reg) | |
27 | { | |
28 | #ifdef CONFIG_SYS_MEMAC_LITTLE_ENDIAN | |
29 | return in_le32(reg); | |
30 | #else | |
31 | return in_be32(reg); | |
32 | #endif | |
33 | } | |
34 | ||
111fd19e RZ |
35 | /* |
36 | * Write value to the PHY for this device to the register at regnum, waiting | |
37 | * until the write is done before it returns. All PHY configuration has to be | |
38 | * done through the TSEC1 MIIM regs | |
39 | */ | |
40 | int memac_mdio_write(struct mii_dev *bus, int port_addr, int dev_addr, | |
41 | int regnum, u16 value) | |
42 | { | |
43 | u32 mdio_ctl; | |
44 | struct memac_mdio_controller *regs = bus->priv; | |
45 | u32 c45 = 1; /* Default to 10G interface */ | |
46 | ||
47 | if (dev_addr == MDIO_DEVAD_NONE) { | |
48 | c45 = 0; /* clause 22 */ | |
49 | dev_addr = regnum & 0x1f; | |
cd348efa | 50 | memac_clrbits_32(®s->mdio_stat, MDIO_STAT_ENC); |
3a7ed5aa | 51 | } else |
cd348efa | 52 | memac_setbits_32(®s->mdio_stat, MDIO_STAT_ENC); |
111fd19e RZ |
53 | |
54 | /* Wait till the bus is free */ | |
cd348efa | 55 | while ((memac_in_32(®s->mdio_stat)) & MDIO_STAT_BSY) |
111fd19e RZ |
56 | ; |
57 | ||
58 | /* Set the port and dev addr */ | |
59 | mdio_ctl = MDIO_CTL_PORT_ADDR(port_addr) | MDIO_CTL_DEV_ADDR(dev_addr); | |
cd348efa | 60 | memac_out_32(®s->mdio_ctl, mdio_ctl); |
111fd19e RZ |
61 | |
62 | /* Set the register address */ | |
63 | if (c45) | |
cd348efa | 64 | memac_out_32(®s->mdio_addr, regnum & 0xffff); |
111fd19e RZ |
65 | |
66 | /* Wait till the bus is free */ | |
cd348efa | 67 | while ((memac_in_32(®s->mdio_stat)) & MDIO_STAT_BSY) |
111fd19e RZ |
68 | ; |
69 | ||
70 | /* Write the value to the register */ | |
cd348efa | 71 | memac_out_32(®s->mdio_data, MDIO_DATA(value)); |
111fd19e RZ |
72 | |
73 | /* Wait till the MDIO write is complete */ | |
cd348efa | 74 | while ((memac_in_32(®s->mdio_data)) & MDIO_DATA_BSY) |
111fd19e RZ |
75 | ; |
76 | ||
77 | return 0; | |
78 | } | |
79 | ||
80 | /* | |
81 | * Reads from register regnum in the PHY for device dev, returning the value. | |
82 | * Clears miimcom first. All PHY configuration has to be done through the | |
83 | * TSEC1 MIIM regs | |
84 | */ | |
85 | int memac_mdio_read(struct mii_dev *bus, int port_addr, int dev_addr, | |
86 | int regnum) | |
87 | { | |
88 | u32 mdio_ctl; | |
89 | struct memac_mdio_controller *regs = bus->priv; | |
90 | u32 c45 = 1; | |
91 | ||
92 | if (dev_addr == MDIO_DEVAD_NONE) { | |
ff5fb2a3 SX |
93 | if (!strcmp(bus->name, DEFAULT_FM_TGEC_MDIO_NAME)) |
94 | return 0xffff; | |
111fd19e RZ |
95 | c45 = 0; /* clause 22 */ |
96 | dev_addr = regnum & 0x1f; | |
cd348efa | 97 | memac_clrbits_32(®s->mdio_stat, MDIO_STAT_ENC); |
3a7ed5aa | 98 | } else |
cd348efa | 99 | memac_setbits_32(®s->mdio_stat, MDIO_STAT_ENC); |
111fd19e RZ |
100 | |
101 | /* Wait till the bus is free */ | |
cd348efa | 102 | while ((memac_in_32(®s->mdio_stat)) & MDIO_STAT_BSY) |
111fd19e RZ |
103 | ; |
104 | ||
105 | /* Set the Port and Device Addrs */ | |
106 | mdio_ctl = MDIO_CTL_PORT_ADDR(port_addr) | MDIO_CTL_DEV_ADDR(dev_addr); | |
cd348efa | 107 | memac_out_32(®s->mdio_ctl, mdio_ctl); |
111fd19e RZ |
108 | |
109 | /* Set the register address */ | |
110 | if (c45) | |
cd348efa | 111 | memac_out_32(®s->mdio_addr, regnum & 0xffff); |
111fd19e RZ |
112 | |
113 | /* Wait till the bus is free */ | |
cd348efa | 114 | while ((memac_in_32(®s->mdio_stat)) & MDIO_STAT_BSY) |
111fd19e RZ |
115 | ; |
116 | ||
117 | /* Initiate the read */ | |
118 | mdio_ctl |= MDIO_CTL_READ; | |
cd348efa | 119 | memac_out_32(®s->mdio_ctl, mdio_ctl); |
111fd19e RZ |
120 | |
121 | /* Wait till the MDIO write is complete */ | |
cd348efa | 122 | while ((memac_in_32(®s->mdio_data)) & MDIO_DATA_BSY) |
111fd19e RZ |
123 | ; |
124 | ||
125 | /* Return all Fs if nothing was there */ | |
cd348efa | 126 | if (memac_in_32(®s->mdio_stat) & MDIO_STAT_RD_ER) |
111fd19e RZ |
127 | return 0xffff; |
128 | ||
cd348efa | 129 | return memac_in_32(®s->mdio_data) & 0xffff; |
111fd19e RZ |
130 | } |
131 | ||
132 | int memac_mdio_reset(struct mii_dev *bus) | |
133 | { | |
134 | return 0; | |
135 | } | |
136 | ||
137 | int fm_memac_mdio_init(bd_t *bis, struct memac_mdio_info *info) | |
138 | { | |
139 | struct mii_dev *bus = mdio_alloc(); | |
140 | ||
141 | if (!bus) { | |
142 | printf("Failed to allocate FM TGEC MDIO bus\n"); | |
143 | return -1; | |
144 | } | |
145 | ||
146 | bus->read = memac_mdio_read; | |
147 | bus->write = memac_mdio_write; | |
148 | bus->reset = memac_mdio_reset; | |
192bc694 | 149 | strcpy(bus->name, info->name); |
111fd19e RZ |
150 | |
151 | bus->priv = info->regs; | |
152 | ||
2ee6c52e PJ |
153 | /* |
154 | * On some platforms like B4860, default value of MDIO_CLK_DIV bits | |
155 | * in mdio_stat(mdio_cfg) register generates MDIO clock too high | |
156 | * (much higher than 2.5MHz), violating the IEEE specs. | |
157 | * On other platforms like T1040, default value of MDIO_CLK_DIV bits | |
158 | * is zero, so MDIO clock is disabled. | |
159 | * So, for proper functioning of MDIO, MDIO_CLK_DIV bits needs to | |
160 | * be properly initialized. | |
ae6b4583 SX |
161 | * NEG bit default should be '1' as per FMAN-v3 RM, but on platform |
162 | * like T2080QDS, this bit default is '0', which leads to MDIO failure | |
163 | * on XAUI PHY, so set this bit definitely. | |
2ee6c52e | 164 | */ |
cd348efa SX |
165 | memac_setbits_32( |
166 | &((struct memac_mdio_controller *)info->regs)->mdio_stat, | |
167 | MDIO_STAT_CLKDIV(258) | MDIO_STAT_NEG); | |
2ee6c52e | 168 | |
111fd19e RZ |
169 | return mdio_register(bus); |
170 | } |