ppc4xx: miiphy.c reworked
[u-boot-openmoko.git] / cpu / ppc4xx / miiphy.c
blobc8827201e9861e3261de443bb26d59cacdfa7bca
1 /*-----------------------------------------------------------------------------+
3 | This source code has been made available to you by IBM on an AS-IS
4 | basis. Anyone receiving this source is licensed under IBM
5 | copyrights to use it in any way he or she deems fit, including
6 | copying it, modifying it, compiling it, and redistributing it either
7 | with or without modifications. No license under IBM patents or
8 | patent applications is to be implied by the copyright license.
10 | Any user of this software should understand that IBM cannot provide
11 | technical support for this software and will not be responsible for
12 | any consequences resulting from the use of this software.
14 | Any person who transfers this source code or any derivative work
15 | must include the IBM copyright notice, this paragraph, and the
16 | preceding two paragraphs in the transferred software.
18 | COPYRIGHT I B M CORPORATION 1995
19 | LICENSED MATERIAL - PROGRAM PROPERTY OF I B M
20 +-----------------------------------------------------------------------------*/
21 /*-----------------------------------------------------------------------------+
23 | File Name: miiphy.c
25 | Function: This module has utilities for accessing the MII PHY through
26 | the EMAC3 macro.
28 | Author: Mark Wisner
30 +-----------------------------------------------------------------------------*/
32 /* define DEBUG for debugging output (obviously ;-)) */
33 #if 0
34 #define DEBUG
35 #endif
37 #include <common.h>
38 #include <asm/processor.h>
39 #include <asm/io.h>
40 #include <ppc_asm.tmpl>
41 #include <commproc.h>
42 #include <ppc4xx_enet.h>
43 #include <405_mal.h>
44 #include <miiphy.h>
46 #if !defined(CONFIG_PHY_CLK_FREQ)
47 #define CONFIG_PHY_CLK_FREQ 0
48 #endif
50 /***********************************************************/
51 /* Dump out to the screen PHY regs */
52 /***********************************************************/
54 void miiphy_dump (char *devname, unsigned char addr)
56 unsigned long i;
57 unsigned short data;
59 for (i = 0; i < 0x1A; i++) {
60 if (miiphy_read (devname, addr, i, &data)) {
61 printf ("read error for reg %lx\n", i);
62 return;
64 printf ("Phy reg %lx ==> %4x\n", i, data);
66 /* jump to the next set of regs */
67 if (i == 0x07)
68 i = 0x0f;
70 } /* end for loop */
71 } /* end dump */
73 /***********************************************************/
74 /* (Re)start autonegotiation */
75 /***********************************************************/
76 int phy_setup_aneg (char *devname, unsigned char addr)
78 u16 bmcr;
80 #if defined(CONFIG_PHY_DYNAMIC_ANEG)
82 * Set up advertisement based on capablilities reported by the PHY.
83 * This should work for both copper and fiber.
85 u16 bmsr;
86 #if defined(CONFIG_PHY_GIGE)
87 u16 exsr = 0x0000;
88 #endif
90 miiphy_read (devname, addr, PHY_BMSR, &bmsr);
92 #if defined(CONFIG_PHY_GIGE)
93 if (bmsr & PHY_BMSR_EXT_STAT)
94 miiphy_read (devname, addr, PHY_EXSR, &exsr);
96 if (exsr & (PHY_EXSR_1000XF | PHY_EXSR_1000XH)) {
97 /* 1000BASE-X */
98 u16 anar = 0x0000;
100 if (exsr & PHY_EXSR_1000XF)
101 anar |= PHY_X_ANLPAR_FD;
103 if (exsr & PHY_EXSR_1000XH)
104 anar |= PHY_X_ANLPAR_HD;
106 miiphy_write (devname, addr, PHY_ANAR, anar);
107 } else
108 #endif
110 u16 anar, btcr;
112 miiphy_read (devname, addr, PHY_ANAR, &anar);
113 anar &= ~(0x5000 | PHY_ANLPAR_T4 | PHY_ANLPAR_TXFD |
114 PHY_ANLPAR_TX | PHY_ANLPAR_10FD | PHY_ANLPAR_10);
116 miiphy_read (devname, addr, PHY_1000BTCR, &btcr);
117 btcr &= ~(0x00FF | PHY_1000BTCR_1000FD | PHY_1000BTCR_1000HD);
119 if (bmsr & PHY_BMSR_100T4)
120 anar |= PHY_ANLPAR_T4;
122 if (bmsr & PHY_BMSR_100TXF)
123 anar |= PHY_ANLPAR_TXFD;
125 if (bmsr & PHY_BMSR_100TXH)
126 anar |= PHY_ANLPAR_TX;
128 if (bmsr & PHY_BMSR_10TF)
129 anar |= PHY_ANLPAR_10FD;
131 if (bmsr & PHY_BMSR_10TH)
132 anar |= PHY_ANLPAR_10;
134 miiphy_write (devname, addr, PHY_ANAR, anar);
136 #if defined(CONFIG_PHY_GIGE)
137 if (exsr & PHY_EXSR_1000TF)
138 btcr |= PHY_1000BTCR_1000FD;
140 if (exsr & PHY_EXSR_1000TH)
141 btcr |= PHY_1000BTCR_1000HD;
143 miiphy_write (devname, addr, PHY_1000BTCR, btcr);
144 #endif
147 #else /* defined(CONFIG_PHY_DYNAMIC_ANEG) */
149 * Set up standard advertisement
151 u16 adv;
153 miiphy_read (devname, addr, PHY_ANAR, &adv);
154 adv |= (PHY_ANLPAR_ACK | PHY_ANLPAR_TXFD | PHY_ANLPAR_TX |
155 PHY_ANLPAR_10FD | PHY_ANLPAR_10);
156 miiphy_write (devname, addr, PHY_ANAR, adv);
158 miiphy_read (devname, addr, PHY_1000BTCR, &adv);
159 adv |= (0x0300);
160 miiphy_write (devname, addr, PHY_1000BTCR, adv);
162 #endif /* defined(CONFIG_PHY_DYNAMIC_ANEG) */
164 /* Start/Restart aneg */
165 miiphy_read (devname, addr, PHY_BMCR, &bmcr);
166 bmcr |= (PHY_BMCR_AUTON | PHY_BMCR_RST_NEG);
167 miiphy_write (devname, addr, PHY_BMCR, bmcr);
169 return 0;
172 /***********************************************************/
173 /* read a phy reg and return the value with a rc */
174 /***********************************************************/
175 /* AMCC_TODO:
176 * Find out of the choice for the emac for MDIO is from the bridges,
177 * i.e. ZMII or RGMII as approporiate. If the bridges are not used
178 * to determine the emac for MDIO, then is the SDR0_ETH_CFG[MDIO_SEL]
179 * used? If so, then this routine below does not apply to the 460EX/GT.
181 * sr: Currently on 460EX only EMAC0 works with MDIO, so we always
182 * return EMAC0 offset here
184 unsigned int miiphy_getemac_offset (void)
186 #if (defined(CONFIG_440) && \
187 !defined(CONFIG_440SP) && !defined(CONFIG_440SPE) && \
188 !defined(CONFIG_460EX) && !defined(CONFIG_460GT)) && \
189 defined(CONFIG_NET_MULTI)
190 unsigned long zmii;
191 unsigned long eoffset;
193 /* Need to find out which mdi port we're using */
194 zmii = in_be32((void *)ZMII_FER);
196 if (zmii & (ZMII_FER_MDI << ZMII_FER_V (0)))
197 /* using port 0 */
198 eoffset = 0;
200 else if (zmii & (ZMII_FER_MDI << ZMII_FER_V (1)))
201 /* using port 1 */
202 eoffset = 0x100;
204 else if (zmii & (ZMII_FER_MDI << ZMII_FER_V (2)))
205 /* using port 2 */
206 eoffset = 0x400;
208 else if (zmii & (ZMII_FER_MDI << ZMII_FER_V (3)))
209 /* using port 3 */
210 eoffset = 0x600;
212 else {
213 /* None of the mdi ports are enabled! */
214 /* enable port 0 */
215 zmii |= ZMII_FER_MDI << ZMII_FER_V (0);
216 out_be32((void *)ZMII_FER, zmii);
217 eoffset = 0;
218 /* need to soft reset port 0 */
219 zmii = in_be32((void *)EMAC_M0);
220 zmii |= EMAC_M0_SRST;
221 out_be32((void *)EMAC_M0, zmii);
224 return (eoffset);
225 #else
227 #if defined(CONFIG_NET_MULTI) && defined(CONFIG_405EX)
228 unsigned long rgmii;
229 int devnum = 1;
231 rgmii = in_be32((void *)RGMII_FER);
232 if (rgmii & (1 << (19 - devnum)))
233 return 0x100;
234 #endif
236 return 0;
237 #endif
240 static int emac_miiphy_wait(u32 emac_reg)
242 u32 sta_reg;
243 int i;
245 /* wait for completion */
246 i = 0;
247 do {
248 sta_reg = in_be32((void *)EMAC_STACR + emac_reg);
249 if (i++ > 5) {
250 debug("%s [%d]: Timeout! EMAC_STACR=0x%0x\n", __func__,
251 __LINE__, sta_reg);
252 return -1;
254 udelay(10);
255 } while ((sta_reg & EMAC_STACR_OC) == EMAC_STACR_OC_MASK);
257 return 0;
260 static int emac_miiphy_command(u8 addr, u8 reg, int cmd, u16 value)
262 u32 emac_reg;
263 u32 sta_reg;
265 emac_reg = miiphy_getemac_offset();
267 /* wait for completion */
268 if (emac_miiphy_wait(emac_reg) != 0)
269 return -1;
271 sta_reg = reg; /* reg address */
273 /* set clock (50Mhz) and read flags */
274 #if defined(CONFIG_440GX) || defined(CONFIG_440SPE) || \
275 defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
276 defined(CONFIG_460EX) || defined(CONFIG_460GT) || \
277 defined(CONFIG_405EX)
278 #if defined(CONFIG_IBM_EMAC4_V4) /* EMAC4 V4 changed bit setting */
279 sta_reg = (sta_reg & ~EMAC_STACR_OP_MASK) | cmd;
280 #else
281 sta_reg |= cmd;
282 #endif
283 #else
284 sta_reg = (sta_reg | cmd) & ~EMAC_STACR_CLK_100MHZ;
285 #endif
287 /* Some boards (mainly 405EP based) define the PHY clock freqency fixed */
288 sta_reg = sta_reg | CONFIG_PHY_CLK_FREQ;
289 sta_reg = sta_reg | ((u32)addr << 5); /* Phy address */
290 sta_reg = sta_reg | EMAC_STACR_OC_MASK; /* new IBM emac v4 */
291 if (cmd == EMAC_STACR_WRITE)
292 memcpy(&sta_reg, &value, 2); /* put in data */
294 out_be32((void *)EMAC_STACR + emac_reg, sta_reg);
295 debug("%s [%d]: sta_reg=%08x\n", __func__, __LINE__, sta_reg);
297 /* wait for completion */
298 if (emac_miiphy_wait(emac_reg) != 0)
299 return -1;
301 debug("%s [%d]: sta_reg=%08x\n", __func__, __LINE__, sta_reg);
302 if ((sta_reg & EMAC_STACR_PHYE) != 0)
303 return -1;
305 return 0;
308 int emac4xx_miiphy_read (char *devname, unsigned char addr, unsigned char reg,
309 unsigned short *value)
311 unsigned long sta_reg;
312 unsigned long emac_reg;
314 emac_reg = miiphy_getemac_offset ();
316 if (emac_miiphy_command(addr, reg, EMAC_STACR_READ, 0) != 0)
317 return -1;
319 sta_reg = in_be32((void *)EMAC_STACR + emac_reg);
320 *value = *(u16 *)(&sta_reg);
322 return 0;
325 /***********************************************************/
326 /* write a phy reg and return the value with a rc */
327 /***********************************************************/
329 int emac4xx_miiphy_write (char *devname, unsigned char addr, unsigned char reg,
330 unsigned short value)
332 return emac_miiphy_command(addr, reg, EMAC_STACR_WRITE, value);