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_FM1_DTSEC >= 6)
  42         FM_DTSEC_INFO_INITIALIZER(1, 6),
  43 #endif
  44 #if (CONFIG_SYS_NUM_FM1_DTSEC >= 7)
  45         FM_DTSEC_INFO_INITIALIZER(1, 9),
  46 #endif
  47 #if (CONFIG_SYS_NUM_FM1_DTSEC >= 8)
  48         FM_DTSEC_INFO_INITIALIZER(1, 10),
  49 #endif
  50 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 1)
  51         FM_DTSEC_INFO_INITIALIZER(2, 1),
  52 #endif
  53 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 2)
  54         FM_DTSEC_INFO_INITIALIZER(2, 2),
  55 #endif
  56 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 3)
  57         FM_DTSEC_INFO_INITIALIZER(2, 3),
  58 #endif
  59 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 4)
  60         FM_DTSEC_INFO_INITIALIZER(2, 4),
  61 #endif
  62 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 5)
  63         FM_DTSEC_INFO_INITIALIZER(2, 5),
  64 #endif
  65 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 6)
  66         FM_DTSEC_INFO_INITIALIZER(2, 6),
  67 #endif
  68 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 7)
  69         FM_DTSEC_INFO_INITIALIZER(2, 9),
  70 #endif
  71 #if (CONFIG_SYS_NUM_FM2_DTSEC >= 8)
  72         FM_DTSEC_INFO_INITIALIZER(2, 10),
  73 #endif
  74 #if (CONFIG_SYS_NUM_FM1_10GEC >= 1)
  75         FM_TGEC_INFO_INITIALIZER(1, 1),
  76 #endif
  77 #if (CONFIG_SYS_NUM_FM1_10GEC >= 2)
  78         FM_TGEC_INFO_INITIALIZER(1, 2),
  79 #endif
  80 #if (CONFIG_SYS_NUM_FM2_10GEC >= 1)
  81         FM_TGEC_INFO_INITIALIZER(2, 1),
  82 #endif
  83 #if (CONFIG_SYS_NUM_FM2_10GEC >= 2)
  84         FM_TGEC_INFO_INITIALIZER(2, 2),
  85 #endif
  86 };
  87
  88 int fm_standard_init(bd_t *bis)
  89 {
  90         int i;
  91         struct ccsr_fman *reg;
  92
  93         reg = (void *)CONFIG_SYS_FSL_FM1_ADDR;
  94         if (fm_init_common(0, reg))
  95                 return 0;
  96
  97         for (i = 0; i < ARRAY_SIZE(fm_info); i++) {
  98                 if ((fm_info[i].enabled) && (fm_info[i].index == 1))
  99                         fm_eth_initialize(reg, &fm_info[i]);
 100         }
 101
 102 #if (CONFIG_SYS_NUM_FMAN == 2)
 103         reg = (void *)CONFIG_SYS_FSL_FM2_ADDR;
 104         if (fm_init_common(1, reg))
 105                 return 0;
 106
 107         for (i = 0; i < ARRAY_SIZE(fm_info); i++) {
 108                 if ((fm_info[i].enabled) && (fm_info[i].index == 2))
 109                         fm_eth_initialize(reg, &fm_info[i]);
 110         }
 111 #endif
 112
 113         return 1;
 114 }
 115
 116 /* simple linear search to map from port to array index */
 117 static int fm_port_to_index(enum fm_port port)
 118 {
 119         int i;
 120
 121         for (i = 0; i < ARRAY_SIZE(fm_info); i++) {
 122                 if (fm_info[i].port == port)
 123                         return i;
 124         }
 125
 126         return -1;
 127 }
 128
 129 /*
 130  * Determine if an interface is actually active based on HW config
 131  * we expect fman_port_enet_if() to report PHY_INTERFACE_MODE_NONE if
 132  * the interface is not active based on HW cfg of the SoC
 133  */
 134 void fman_enet_init(void)
 135 {
 136         int i;
 137
 138         for (i = 0; i < ARRAY_SIZE(fm_info); i++) {
 139                 phy_interface_t enet_if;
 140
 141                 enet_if = fman_port_enet_if(fm_info[i].port);
 142                 if (enet_if != PHY_INTERFACE_MODE_NONE) {
 143                         fm_info[i].enabled = 1;
 144                         fm_info[i].enet_if = enet_if;
 145                 } else {
 146                         fm_info[i].enabled = 0;
 147                 }
 148         }
 149
 150         return ;
 151 }
 152
 153 void fm_disable_port(enum fm_port port)
 154 {
 155         int i = fm_port_to_index(port);
 156
 157         fm_info[i].enabled = 0;
 158         fman_disable_port(port);
 159 }
 160
 161 void fm_info_set_mdio(enum fm_port port, struct mii_dev *bus)
 162 {
 163         int i = fm_port_to_index(port);
 164
 165         if (i == -1)
 166                 return;
 167
 168         fm_info[i].bus = bus;
 169 }
 170
 171 void fm_info_set_phy_address(enum fm_port port, int address)
 172 {
 173         int i = fm_port_to_index(port);
 174
 175         if (i == -1)
 176                 return;
 177
 178         fm_info[i].phy_addr = address;
 179 }
 180
 181 /*
 182  * Returns the PHY address for a given Fman port
 183  *
 184  * The port must be set via a prior call to fm_info_set_phy_address().
 185  * A negative error code is returned if the port is invalid.
 186  */
 187 int fm_info_get_phy_address(enum fm_port port)
 188 {
 189         int i = fm_port_to_index(port);
 190
 191         if (i == -1)
 192                 return -1;
 193
 194         return fm_info[i].phy_addr;
 195 }
 196
 197 /*
 198  * Returns the type of the data interface between the given MAC and its PHY.
 199  * This is typically determined by the RCW.
 200  */
 201 phy_interface_t fm_info_get_enet_if(enum fm_port port)
 202 {
 203         int i = fm_port_to_index(port);
 204
 205         if (i == -1)
 206                 return PHY_INTERFACE_MODE_NONE;
 207
 208         if (fm_info[i].enabled)
 209                 return fm_info[i].enet_if;
 210
 211         return PHY_INTERFACE_MODE_NONE;
 212 }
 213
 214 static void
 215 __def_board_ft_fman_fixup_port(void *blob, char * prop, phys_addr_t pa,
 216                                 enum fm_port port, int offset)
 217 {
 218         return ;
 219 }
 220
 221 void board_ft_fman_fixup_port(void *blob, char * prop, phys_addr_t pa,
 222                                 enum fm_port port, int offset)
 223          __attribute__((weak, alias("__def_board_ft_fman_fixup_port")));
 224
 225 static void ft_fixup_port(void *blob, struct fm_eth_info *info, char *prop)
 226 {
 227         int off;
 228         uint32_t ph;
 229         phys_addr_t paddr = CONFIG_SYS_CCSRBAR_PHYS + info->compat_offset;
 230         u64 dtsec1_addr = (u64)CONFIG_SYS_CCSRBAR_PHYS +
 231                                 CONFIG_SYS_FSL_FM1_DTSEC1_OFFSET;
 232
 233         off = fdt_node_offset_by_compat_reg(blob, prop, paddr);
 234
 235         if (info->enabled) {
 236                 fdt_fixup_phy_connection(blob, off, info->enet_if);
 237                 board_ft_fman_fixup_port(blob, prop, paddr, info->port, off);
 238                 return ;
 239         }
 240
 241 #ifdef CONFIG_SYS_FMAN_V3
 242         /*
 243          * Physically FM1_DTSEC9 and FM1_10GEC1 use the same dual-role MAC, when
 244          * FM1_10GEC1 is enabled and  FM1_DTSEC9 is disabled, ensure that the
 245          * dual-role MAC is not disabled, ditto for other dual-role MACs.
 246          */
 247         if (((info->port == FM1_DTSEC9) && (PORT_IS_ENABLED(FM1_10GEC1)))       ||
 248             ((info->port == FM1_DTSEC10) && (PORT_IS_ENABLED(FM1_10GEC2)))      ||
 249             ((info->port == FM1_10GEC1) && (PORT_IS_ENABLED(FM1_DTSEC9)))       ||
 250             ((info->port == FM1_10GEC2) && (PORT_IS_ENABLED(FM1_DTSEC10)))
 251 #if (CONFIG_SYS_NUM_FMAN == 2)
 252                                                                                 ||
 253             ((info->port == FM2_DTSEC9) && (PORT_IS_ENABLED(FM2_10GEC1)))       ||
 254             ((info->port == FM2_DTSEC10) && (PORT_IS_ENABLED(FM2_10GEC2)))      ||
 255             ((info->port == FM2_10GEC1) && (PORT_IS_ENABLED(FM2_DTSEC9)))       ||
 256             ((info->port == FM2_10GEC2) && (PORT_IS_ENABLED(FM2_DTSEC10)))
 257 #endif
 258         )
 259                 return;
 260 #endif
 261         /* board code might have caused offset to change */
 262         off = fdt_node_offset_by_compat_reg(blob, prop, paddr);
 263
 264         /* Don't disable FM1-DTSEC1 MAC as its used for MDIO */
 265         if (paddr != dtsec1_addr)
 266                 fdt_status_disabled(blob, off); /* disable the MAC node */
 267
 268         /* disable the fsl,dpa-ethernet node that points to the MAC */
 269         ph = fdt_get_phandle(blob, off);
 270         do_fixup_by_prop(blob, "fsl,fman-mac", &ph, sizeof(ph),
 271                 "status", "disabled", strlen("disabled") + 1, 1);
 272 }
 273
 274 void fdt_fixup_fman_ethernet(void *blob)
 275 {
 276         int i;
 277
 278 #ifdef CONFIG_SYS_FMAN_V3
 279         for (i = 0; i < ARRAY_SIZE(fm_info); i++)
 280                 ft_fixup_port(blob, &fm_info[i], "fsl,fman-memac");
 281 #else
 282         for (i = 0; i < ARRAY_SIZE(fm_info); i++) {
 283                 if (fm_info[i].type == FM_ETH_1G_E)
 284                         ft_fixup_port(blob, &fm_info[i], "fsl,fman-1g-mac");
 285                 else
 286                         ft_fixup_port(blob, &fm_info[i], "fsl,fman-10g-mac");
 287         }
 288 #endif
 289 }