]> git.sur5r.net Git - u-boot/blob - drivers/net/fm/p1023.c
Merge branch 'master' of git://git.denx.de/u-boot-ubi
[u-boot] / drivers / net / fm / p1023.c
1 /*
2  * Copyright 2011 Freescale Semiconductor, Inc.
3  *
4  * This program is free software; you can redistribute it and/or
5  * modify it under the terms of the GNU General Public License as
6  * published by the Free Software Foundation; either version 2 of
7  * the License, or (at your option) any later version.
8  *
9  * This program is distributed in the hope that it will be useful,
10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12  * GNU General Public License for more details.
13  *
14  * You should have received a copy of the GNU General Public License
15  * along with this program; if not, write to the Free Software
16  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
17  * MA 02111-1307 USA
18  */
19 #include <common.h>
20 #include <phy.h>
21 #include <fm_eth.h>
22 #include <asm/io.h>
23 #include <asm/immap_85xx.h>
24 #include <asm/fsl_serdes.h>
25
26 u32 port_to_devdisr[] = {
27         [FM1_DTSEC1] = MPC85xx_DEVDISR_TSEC1,
28         [FM1_DTSEC2] = MPC85xx_DEVDISR_TSEC2,
29 };
30
31 static int is_device_disabled(enum fm_port port)
32 {
33         ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
34         u32 devdisr = in_be32(&gur->devdisr);
35
36         return port_to_devdisr[port] & devdisr;
37 }
38
39 void fman_disable_port(enum fm_port port)
40 {
41         ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
42         setbits_be32(&gur->devdisr, port_to_devdisr[port]);
43 }
44
45 phy_interface_t fman_port_enet_if(enum fm_port port)
46 {
47         ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
48         u32 pordevsr = in_be32(&gur->pordevsr);
49
50         if (is_device_disabled(port))
51                 return PHY_INTERFACE_MODE_NONE;
52
53         /* DTSEC1 can be SGMII, RGMII or RMII */
54         if (port == FM1_DTSEC1) {
55                 if (is_serdes_configured(SGMII_FM1_DTSEC1))
56                         return PHY_INTERFACE_MODE_SGMII;
57                 if (pordevsr & MPC85xx_PORDEVSR_SGMII1_DIS) {
58                         if (pordevsr & MPC85xx_PORDEVSR_TSEC1_PRTC)
59                                 return PHY_INTERFACE_MODE_RGMII;
60                         else
61                                 return PHY_INTERFACE_MODE_RMII;
62                 }
63         }
64
65         /* DTSEC2 only supports SGMII or RGMII */
66         if (port == FM1_DTSEC2) {
67                 if (is_serdes_configured(SGMII_FM1_DTSEC2))
68                         return PHY_INTERFACE_MODE_SGMII;
69                 if (pordevsr & MPC85xx_PORDEVSR_SGMII2_DIS)
70                         return PHY_INTERFACE_MODE_RGMII;
71         }
72
73         return PHY_INTERFACE_MODE_NONE;
74 }