]> git.sur5r.net Git - u-boot/blob - drivers/net/fm/init.c
Merge branch 'master' of git://git.denx.de/u-boot-ubi
[u-boot] / drivers / net / fm / init.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 <asm/io.h>
21 #include <asm/fsl_serdes.h>
22
23 #include "fm.h"
24
25 struct fm_eth_info fm_info[] = {
26 #if (CONFIG_SYS_NUM_FM1_DTSEC >= 1)
27         FM_DTSEC_INFO_INITIALIZER(1, 1),
28 #endif
29 #if (CONFIG_SYS_NUM_FM1_DTSEC >= 2)
30         FM_DTSEC_INFO_INITIALIZER(1, 2),
31 #endif
32 #if (CONFIG_SYS_NUM_FM1_DTSEC >= 3)
33         FM_DTSEC_INFO_INITIALIZER(1, 3),
34 #endif
35 #if (CONFIG_SYS_NUM_FM1_DTSEC >= 4)
36         FM_DTSEC_INFO_INITIALIZER(1, 4),
37 #endif
38 #if (CONFIG_SYS_NUM_FM1_DTSEC >= 5)
39         FM_DTSEC_INFO_INITIALIZER(1, 5),
40 #endif
41 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 1)
42         FM_DTSEC_INFO_INITIALIZER(2, 1),
43 #endif
44 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 2)
45         FM_DTSEC_INFO_INITIALIZER(2, 2),
46 #endif
47 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 3)
48         FM_DTSEC_INFO_INITIALIZER(2, 3),
49 #endif
50 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 4)
51         FM_DTSEC_INFO_INITIALIZER(2, 4),
52 #endif
53 #if (CONFIG_SYS_NUM_FM1_10GEC >= 1)
54         FM_TGEC_INFO_INITIALIZER(1, 1),
55 #endif
56 #if (CONFIG_SYS_NUM_FM2_10GEC >= 1)
57         FM_TGEC_INFO_INITIALIZER(2, 1),
58 #endif
59 };
60
61 int fm_standard_init(bd_t *bis)
62 {
63         int i;
64         struct ccsr_fman *reg;
65
66         reg = (void *)CONFIG_SYS_FSL_FM1_ADDR;
67         if (fm_init_common(0, reg))
68                 return 0;
69
70         for (i = 0; i < ARRAY_SIZE(fm_info); i++) {
71                 if ((fm_info[i].enabled) && (fm_info[i].index == 1))
72                         fm_eth_initialize(reg, &fm_info[i]);
73         }
74
75 #if (CONFIG_SYS_NUM_FMAN == 2)
76         reg = (void *)CONFIG_SYS_FSL_FM2_ADDR;
77         if (fm_init_common(1, reg))
78                 return 0;
79
80         for (i = 0; i < ARRAY_SIZE(fm_info); i++) {
81                 if ((fm_info[i].enabled) && (fm_info[i].index == 2))
82                         fm_eth_initialize(reg, &fm_info[i]);
83         }
84 #endif
85
86         return 1;
87 }
88
89 /* simple linear search to map from port to array index */
90 static int fm_port_to_index(enum fm_port port)
91 {
92         int i;
93
94         for (i = 0; i < ARRAY_SIZE(fm_info); i++) {
95                 if (fm_info[i].port == port)
96                         return i;
97         }
98
99         return -1;
100 }
101
102 /*
103  * Determine if an interface is actually active based on HW config
104  * we expect fman_port_enet_if() to report PHY_INTERFACE_MODE_NONE if
105  * the interface is not active based on HW cfg of the SoC
106  */
107 void fman_enet_init(void)
108 {
109         int i;
110
111         for (i = 0; i < ARRAY_SIZE(fm_info); i++) {
112                 phy_interface_t enet_if;
113
114                 enet_if = fman_port_enet_if(fm_info[i].port);
115                 if (enet_if != PHY_INTERFACE_MODE_NONE) {
116                         fm_info[i].enabled = 1;
117                         fm_info[i].enet_if = enet_if;
118                 } else {
119                         fm_info[i].enabled = 0;
120                 }
121         }
122
123         return ;
124 }
125
126 void fm_disable_port(enum fm_port port)
127 {
128         int i = fm_port_to_index(port);
129
130         fm_info[i].enabled = 0;
131         fman_disable_port(port);
132 }
133
134 void fm_info_set_mdio(enum fm_port port, struct mii_dev *bus)
135 {
136         int i = fm_port_to_index(port);
137
138         if (i == -1)
139                 return;
140
141         fm_info[i].bus = bus;
142 }
143
144 void fm_info_set_phy_address(enum fm_port port, int address)
145 {
146         int i = fm_port_to_index(port);
147
148         if (i == -1)
149                 return;
150
151         fm_info[i].phy_addr = address;
152 }
153
154 /*
155  * Returns the type of the data interface between the given MAC and its PHY.
156  * This is typically determined by the RCW.
157  */
158 phy_interface_t fm_info_get_enet_if(enum fm_port port)
159 {
160         int i = fm_port_to_index(port);
161
162         if (i == -1)
163                 return PHY_INTERFACE_MODE_NONE;
164
165         if (fm_info[i].enabled)
166                 return fm_info[i].enet_if;
167
168         return PHY_INTERFACE_MODE_NONE;
169 }
170
171 static void
172 __def_board_ft_fman_fixup_port(void *blob, char * prop, phys_addr_t pa,
173                                 enum fm_port port, int offset)
174 {
175         return ;
176 }
177
178 void board_ft_fman_fixup_port(void *blob, char * prop, phys_addr_t pa,
179                                 enum fm_port port, int offset)
180          __attribute__((weak, alias("__def_board_ft_fman_fixup_port")));
181
182 static void ft_fixup_port(void *blob, struct fm_eth_info *info, char *prop)
183 {
184         int off, ph;
185         phys_addr_t paddr = CONFIG_SYS_CCSRBAR_PHYS + info->compat_offset;
186
187         off = fdt_node_offset_by_compat_reg(blob, prop, paddr);
188
189         if (info->enabled) {
190                 fdt_fixup_phy_connection(blob, off, info->enet_if);
191                 board_ft_fman_fixup_port(blob, prop, paddr, info->port, off);
192                 return ;
193         }
194
195         /* board code might have caused offset to change */
196         off = fdt_node_offset_by_compat_reg(blob, prop, paddr);
197
198         /* disable both the mac node and the node that has a handle to it */
199         fdt_setprop_string(blob, off, "status", "disabled");
200
201         ph = fdt_get_phandle(blob, off);
202         do_fixup_by_prop(blob, "fsl,fman-mac", &ph, sizeof(ph),
203                 "status", "disabled", strlen("disabled") + 1, 1);
204 }
205
206 void fdt_fixup_fman_ethernet(void *blob)
207 {
208         int i;
209
210         for (i = 0; i < ARRAY_SIZE(fm_info); i++) {
211                 if (fm_info[i].type == FM_ETH_1G_E)
212                         ft_fixup_port(blob, &fm_info[i], "fsl,fman-1g-mac");
213                 else
214                         ft_fixup_port(blob, &fm_info[i], "fsl,fman-10g-mac");
215         }
216 }