git.sur5r.net Git - u-boot/blob - 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_info_set_mdio(enum fm_port port, struct mii_dev *bus)
 127 {
 128         int i = fm_port_to_index(port);
 129
 130         if (i == -1)
 131                 return;
 132
 133         fm_info[i].bus = bus;
 134 }
 135
 136 void fm_info_set_phy_address(enum fm_port port, int address)
 137 {
 138         int i = fm_port_to_index(port);
 139
 140         if (i == -1)
 141                 return;
 142
 143         fm_info[i].phy_addr = address;
 144 }
 145
 146 /*
 147  * Returns the type of the data interface between the given MAC and its PHY.
 148  * This is typically determined by the RCW.
 149  */
 150 phy_interface_t fm_info_get_enet_if(enum fm_port port)
 151 {
 152         int i = fm_port_to_index(port);
 153
 154         if (i == -1)
 155                 return PHY_INTERFACE_MODE_NONE;
 156
 157         if (fm_info[i].enabled)
 158                 return fm_info[i].enet_if;
 159
 160         return PHY_INTERFACE_MODE_NONE;
 161 }
 162
 163 static void
 164 __def_board_ft_fman_fixup_port(void *blob, char * prop, phys_addr_t pa,
 165                                 enum fm_port port, int offset)
 166 {
 167         return ;
 168 }
 169
 170 void board_ft_fman_fixup_port(void *blob, char * prop, phys_addr_t pa,
 171                                 enum fm_port port, int offset)
 172          __attribute__((weak, alias("__def_board_ft_fman_fixup_port")));
 173
 174 static void ft_fixup_port(void *blob, struct fm_eth_info *info, char *prop)
 175 {
 176         int off, ph;
 177         phys_addr_t paddr = CONFIG_SYS_CCSRBAR_PHYS + info->compat_offset;
 178
 179         off = fdt_node_offset_by_compat_reg(blob, prop, paddr);
 180
 181         if (info->enabled) {
 182                 fdt_fixup_phy_connection(blob, off, info->enet_if);
 183                 board_ft_fman_fixup_port(blob, prop, paddr, info->port, off);
 184                 return ;
 185         }
 186
 187         /* board code might have caused offset to change */
 188         off = fdt_node_offset_by_compat_reg(blob, prop, paddr);
 189
 190         /* disable both the mac node and the node that has a handle to it */
 191         fdt_setprop_string(blob, off, "status", "disabled");
 192
 193         ph = fdt_get_phandle(blob, off);
 194         do_fixup_by_prop(blob, "fsl,fman-mac", &ph, sizeof(ph),
 195                 "status", "disabled", strlen("disabled") + 1, 1);
 196 }
 197
 198 void fdt_fixup_fman_ethernet(void *blob)
 199 {
 200         int i;
 201
 202         for (i = 0; i < ARRAY_SIZE(fm_info); i++) {
 203                 if (fm_info[i].type == FM_ETH_1G_E)
 204                         ft_fixup_port(blob, &fm_info[i], "fsl,fman-1g-mac");
 205                 else
 206                         ft_fixup_port(blob, &fm_info[i], "fsl,fman-10g-mac");
 207         }
 208 }