1c916d7c9SKumar Gala /* 2c916d7c9SKumar Gala * Copyright 2011 Freescale Semiconductor, Inc. 3c916d7c9SKumar Gala * 4c916d7c9SKumar Gala * This program is free software; you can redistribute it and/or 5c916d7c9SKumar Gala * modify it under the terms of the GNU General Public License as 6c916d7c9SKumar Gala * published by the Free Software Foundation; either version 2 of 7c916d7c9SKumar Gala * the License, or (at your option) any later version. 8c916d7c9SKumar Gala * 9c916d7c9SKumar Gala * This program is distributed in the hope that it will be useful, 10c916d7c9SKumar Gala * but WITHOUT ANY WARRANTY; without even the implied warranty of 11c916d7c9SKumar Gala * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 12c916d7c9SKumar Gala * GNU General Public License for more details. 13c916d7c9SKumar Gala * 14c916d7c9SKumar Gala * You should have received a copy of the GNU General Public License 15c916d7c9SKumar Gala * along with this program; if not, write to the Free Software 16c916d7c9SKumar Gala * Foundation, Inc., 59 Temple Place, Suite 330, Boston, 17c916d7c9SKumar Gala * MA 02111-1307 USA 18c916d7c9SKumar Gala */ 19c916d7c9SKumar Gala #include <common.h> 20c916d7c9SKumar Gala #include <asm/io.h> 21c916d7c9SKumar Gala #include <asm/fsl_serdes.h> 22c916d7c9SKumar Gala 23c916d7c9SKumar Gala #include "fm.h" 24c916d7c9SKumar Gala 25c916d7c9SKumar Gala struct fm_eth_info fm_info[] = { 26c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM1_DTSEC >= 1) 27c916d7c9SKumar Gala FM_DTSEC_INFO_INITIALIZER(1, 1), 28c916d7c9SKumar Gala #endif 29c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM1_DTSEC >= 2) 30c916d7c9SKumar Gala FM_DTSEC_INFO_INITIALIZER(1, 2), 31c916d7c9SKumar Gala #endif 32c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM1_DTSEC >= 3) 33c916d7c9SKumar Gala FM_DTSEC_INFO_INITIALIZER(1, 3), 34c916d7c9SKumar Gala #endif 35c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM1_DTSEC >= 4) 36c916d7c9SKumar Gala FM_DTSEC_INFO_INITIALIZER(1, 4), 37c916d7c9SKumar Gala #endif 38c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM1_DTSEC >= 5) 39c916d7c9SKumar Gala FM_DTSEC_INFO_INITIALIZER(1, 5), 40c916d7c9SKumar Gala #endif 419e758758SYork Sun #if (CONFIG_SYS_NUM_FM1_DTSEC >= 6) 429e758758SYork Sun FM_DTSEC_INFO_INITIALIZER(1, 6), 439e758758SYork Sun #endif 449e758758SYork Sun #if (CONFIG_SYS_NUM_FM1_DTSEC >= 7) 459e758758SYork Sun FM_DTSEC_INFO_INITIALIZER(1, 9), 469e758758SYork Sun #endif 479e758758SYork Sun #if (CONFIG_SYS_NUM_FM1_DTSEC >= 8) 489e758758SYork Sun FM_DTSEC_INFO_INITIALIZER(1, 10), 499e758758SYork Sun #endif 50c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM2_DTSEC >= 1) 51c916d7c9SKumar Gala FM_DTSEC_INFO_INITIALIZER(2, 1), 52c916d7c9SKumar Gala #endif 53c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM2_DTSEC >= 2) 54c916d7c9SKumar Gala FM_DTSEC_INFO_INITIALIZER(2, 2), 55c916d7c9SKumar Gala #endif 56c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM2_DTSEC >= 3) 57c916d7c9SKumar Gala FM_DTSEC_INFO_INITIALIZER(2, 3), 58c916d7c9SKumar Gala #endif 59c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM2_DTSEC >= 4) 60c916d7c9SKumar Gala FM_DTSEC_INFO_INITIALIZER(2, 4), 61c916d7c9SKumar Gala #endif 6299abf7deSTimur Tabi #if (CONFIG_SYS_NUM_FM2_DTSEC >= 5) 6399abf7deSTimur Tabi FM_DTSEC_INFO_INITIALIZER(2, 5), 6499abf7deSTimur Tabi #endif 659e758758SYork Sun #if (CONFIG_SYS_NUM_FM2_DTSEC >= 6) 669e758758SYork Sun FM_DTSEC_INFO_INITIALIZER(2, 6), 679e758758SYork Sun #endif 689e758758SYork Sun #if (CONFIG_SYS_NUM_FM2_DTSEC >= 7) 699e758758SYork Sun FM_DTSEC_INFO_INITIALIZER(2, 9), 709e758758SYork Sun #endif 719e758758SYork Sun #if (CONFIG_SYS_NUM_FM2_DTSEC >= 8) 729e758758SYork Sun FM_DTSEC_INFO_INITIALIZER(2, 10), 739e758758SYork Sun #endif 74c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM1_10GEC >= 1) 75c916d7c9SKumar Gala FM_TGEC_INFO_INITIALIZER(1, 1), 76c916d7c9SKumar Gala #endif 77944b6ccfSShaohui Xie #if (CONFIG_SYS_NUM_FM1_10GEC >= 2) 78944b6ccfSShaohui Xie FM_TGEC_INFO_INITIALIZER(1, 2), 79944b6ccfSShaohui Xie #endif 80c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM2_10GEC >= 1) 81c916d7c9SKumar Gala FM_TGEC_INFO_INITIALIZER(2, 1), 82c916d7c9SKumar Gala #endif 83944b6ccfSShaohui Xie #if (CONFIG_SYS_NUM_FM2_10GEC >= 2) 84944b6ccfSShaohui Xie FM_TGEC_INFO_INITIALIZER(2, 2), 85944b6ccfSShaohui Xie #endif 86c916d7c9SKumar Gala }; 87c916d7c9SKumar Gala 88c916d7c9SKumar Gala int fm_standard_init(bd_t *bis) 89c916d7c9SKumar Gala { 90c916d7c9SKumar Gala int i; 91c916d7c9SKumar Gala struct ccsr_fman *reg; 92c916d7c9SKumar Gala 93c916d7c9SKumar Gala reg = (void *)CONFIG_SYS_FSL_FM1_ADDR; 94c916d7c9SKumar Gala if (fm_init_common(0, reg)) 95c916d7c9SKumar Gala return 0; 96c916d7c9SKumar Gala 97c916d7c9SKumar Gala for (i = 0; i < ARRAY_SIZE(fm_info); i++) { 98c916d7c9SKumar Gala if ((fm_info[i].enabled) && (fm_info[i].index == 1)) 99c916d7c9SKumar Gala fm_eth_initialize(reg, &fm_info[i]); 100c916d7c9SKumar Gala } 101c916d7c9SKumar Gala 102c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FMAN == 2) 103c916d7c9SKumar Gala reg = (void *)CONFIG_SYS_FSL_FM2_ADDR; 104c916d7c9SKumar Gala if (fm_init_common(1, reg)) 105c916d7c9SKumar Gala return 0; 106c916d7c9SKumar Gala 107c916d7c9SKumar Gala for (i = 0; i < ARRAY_SIZE(fm_info); i++) { 108c916d7c9SKumar Gala if ((fm_info[i].enabled) && (fm_info[i].index == 2)) 109c916d7c9SKumar Gala fm_eth_initialize(reg, &fm_info[i]); 110c916d7c9SKumar Gala } 111c916d7c9SKumar Gala #endif 112c916d7c9SKumar Gala 113c916d7c9SKumar Gala return 1; 114c916d7c9SKumar Gala } 115c916d7c9SKumar Gala 116c916d7c9SKumar Gala /* simple linear search to map from port to array index */ 117c916d7c9SKumar Gala static int fm_port_to_index(enum fm_port port) 118c916d7c9SKumar Gala { 119c916d7c9SKumar Gala int i; 120c916d7c9SKumar Gala 121c916d7c9SKumar Gala for (i = 0; i < ARRAY_SIZE(fm_info); i++) { 122c916d7c9SKumar Gala if (fm_info[i].port == port) 123c916d7c9SKumar Gala return i; 124c916d7c9SKumar Gala } 125c916d7c9SKumar Gala 126c916d7c9SKumar Gala return -1; 127c916d7c9SKumar Gala } 128c916d7c9SKumar Gala 129c916d7c9SKumar Gala /* 130c916d7c9SKumar Gala * Determine if an interface is actually active based on HW config 131c916d7c9SKumar Gala * we expect fman_port_enet_if() to report PHY_INTERFACE_MODE_NONE if 132c916d7c9SKumar Gala * the interface is not active based on HW cfg of the SoC 133c916d7c9SKumar Gala */ 134c916d7c9SKumar Gala void fman_enet_init(void) 135c916d7c9SKumar Gala { 136c916d7c9SKumar Gala int i; 137c916d7c9SKumar Gala 138c916d7c9SKumar Gala for (i = 0; i < ARRAY_SIZE(fm_info); i++) { 139c916d7c9SKumar Gala phy_interface_t enet_if; 140c916d7c9SKumar Gala 141c916d7c9SKumar Gala enet_if = fman_port_enet_if(fm_info[i].port); 142c916d7c9SKumar Gala if (enet_if != PHY_INTERFACE_MODE_NONE) { 143c916d7c9SKumar Gala fm_info[i].enabled = 1; 144c916d7c9SKumar Gala fm_info[i].enet_if = enet_if; 145c916d7c9SKumar Gala } else { 146c916d7c9SKumar Gala fm_info[i].enabled = 0; 147c916d7c9SKumar Gala } 148c916d7c9SKumar Gala } 149c916d7c9SKumar Gala 150c916d7c9SKumar Gala return ; 151c916d7c9SKumar Gala } 152c916d7c9SKumar Gala 15369a85242SKumar Gala void fm_disable_port(enum fm_port port) 15469a85242SKumar Gala { 15569a85242SKumar Gala int i = fm_port_to_index(port); 15669a85242SKumar Gala 15769a85242SKumar Gala fm_info[i].enabled = 0; 15869a85242SKumar Gala fman_disable_port(port); 15969a85242SKumar Gala } 16069a85242SKumar Gala 161c916d7c9SKumar Gala void fm_info_set_mdio(enum fm_port port, struct mii_dev *bus) 162c916d7c9SKumar Gala { 163c916d7c9SKumar Gala int i = fm_port_to_index(port); 164c916d7c9SKumar Gala 165c916d7c9SKumar Gala if (i == -1) 166c916d7c9SKumar Gala return; 167c916d7c9SKumar Gala 168c916d7c9SKumar Gala fm_info[i].bus = bus; 169c916d7c9SKumar Gala } 170c916d7c9SKumar Gala 171c916d7c9SKumar Gala void fm_info_set_phy_address(enum fm_port port, int address) 172c916d7c9SKumar Gala { 173c916d7c9SKumar Gala int i = fm_port_to_index(port); 174c916d7c9SKumar Gala 175c916d7c9SKumar Gala if (i == -1) 176c916d7c9SKumar Gala return; 177c916d7c9SKumar Gala 178c916d7c9SKumar Gala fm_info[i].phy_addr = address; 179c916d7c9SKumar Gala } 180c916d7c9SKumar Gala 181c916d7c9SKumar Gala /* 182ae2291fbSTimur Tabi * Returns the PHY address for a given Fman port 183ae2291fbSTimur Tabi * 184ae2291fbSTimur Tabi * The port must be set via a prior call to fm_info_set_phy_address(). 185ae2291fbSTimur Tabi * A negative error code is returned if the port is invalid. 186ae2291fbSTimur Tabi */ 187ae2291fbSTimur Tabi int fm_info_get_phy_address(enum fm_port port) 188ae2291fbSTimur Tabi { 189ae2291fbSTimur Tabi int i = fm_port_to_index(port); 190ae2291fbSTimur Tabi 191ae2291fbSTimur Tabi if (i == -1) 192ae2291fbSTimur Tabi return -1; 193ae2291fbSTimur Tabi 194ae2291fbSTimur Tabi return fm_info[i].phy_addr; 195ae2291fbSTimur Tabi } 196ae2291fbSTimur Tabi 197ae2291fbSTimur Tabi /* 198c916d7c9SKumar Gala * Returns the type of the data interface between the given MAC and its PHY. 199c916d7c9SKumar Gala * This is typically determined by the RCW. 200c916d7c9SKumar Gala */ 201c916d7c9SKumar Gala phy_interface_t fm_info_get_enet_if(enum fm_port port) 202c916d7c9SKumar Gala { 203c916d7c9SKumar Gala int i = fm_port_to_index(port); 204c916d7c9SKumar Gala 205c916d7c9SKumar Gala if (i == -1) 206c916d7c9SKumar Gala return PHY_INTERFACE_MODE_NONE; 207c916d7c9SKumar Gala 208c916d7c9SKumar Gala if (fm_info[i].enabled) 209c916d7c9SKumar Gala return fm_info[i].enet_if; 210c916d7c9SKumar Gala 211c916d7c9SKumar Gala return PHY_INTERFACE_MODE_NONE; 212c916d7c9SKumar Gala } 213c916d7c9SKumar Gala 214c916d7c9SKumar Gala static void 215c916d7c9SKumar Gala __def_board_ft_fman_fixup_port(void *blob, char * prop, phys_addr_t pa, 216c916d7c9SKumar Gala enum fm_port port, int offset) 217c916d7c9SKumar Gala { 218c916d7c9SKumar Gala return ; 219c916d7c9SKumar Gala } 220c916d7c9SKumar Gala 221c916d7c9SKumar Gala void board_ft_fman_fixup_port(void *blob, char * prop, phys_addr_t pa, 222c916d7c9SKumar Gala enum fm_port port, int offset) 223c916d7c9SKumar Gala __attribute__((weak, alias("__def_board_ft_fman_fixup_port"))); 224c916d7c9SKumar Gala 225c916d7c9SKumar Gala static void ft_fixup_port(void *blob, struct fm_eth_info *info, char *prop) 226c916d7c9SKumar Gala { 2274376b4c0STimur Tabi int off; 2284376b4c0STimur Tabi uint32_t ph; 229c916d7c9SKumar Gala phys_addr_t paddr = CONFIG_SYS_CCSRBAR_PHYS + info->compat_offset; 230e81c0abaSKumar Gala u64 dtsec1_addr = (u64)CONFIG_SYS_CCSRBAR_PHYS + 231e81c0abaSKumar Gala CONFIG_SYS_FSL_FM1_DTSEC1_OFFSET; 232c916d7c9SKumar Gala 233c916d7c9SKumar Gala off = fdt_node_offset_by_compat_reg(blob, prop, paddr); 234c916d7c9SKumar Gala 235c916d7c9SKumar Gala if (info->enabled) { 236c916d7c9SKumar Gala fdt_fixup_phy_connection(blob, off, info->enet_if); 237c916d7c9SKumar Gala board_ft_fman_fixup_port(blob, prop, paddr, info->port, off); 238c916d7c9SKumar Gala return ; 239c916d7c9SKumar Gala } 240c916d7c9SKumar Gala 241*ae8a5d10SShengzhou Liu #ifdef CONFIG_SYS_FMAN_V3 242*ae8a5d10SShengzhou Liu /* 243*ae8a5d10SShengzhou Liu * Physically FM1_DTSEC9 and FM1_10GEC1 use the same dual-role MAC, when 244*ae8a5d10SShengzhou Liu * FM1_10GEC1 is enabled and FM1_DTSEC9 is disabled, ensure that the 245*ae8a5d10SShengzhou Liu * dual-role MAC is not disabled, ditto for other dual-role MACs. 246*ae8a5d10SShengzhou Liu */ 247*ae8a5d10SShengzhou Liu if (((info->port == FM1_DTSEC9) && (PORT_IS_ENABLED(FM1_10GEC1))) || 248*ae8a5d10SShengzhou Liu ((info->port == FM1_DTSEC10) && (PORT_IS_ENABLED(FM1_10GEC2))) || 249*ae8a5d10SShengzhou Liu ((info->port == FM1_10GEC1) && (PORT_IS_ENABLED(FM1_DTSEC9))) || 250*ae8a5d10SShengzhou Liu ((info->port == FM1_10GEC2) && (PORT_IS_ENABLED(FM1_DTSEC10))) 251*ae8a5d10SShengzhou Liu #if (CONFIG_SYS_NUM_FMAN == 2) 252*ae8a5d10SShengzhou Liu || 253*ae8a5d10SShengzhou Liu ((info->port == FM2_DTSEC9) && (PORT_IS_ENABLED(FM2_10GEC1))) || 254*ae8a5d10SShengzhou Liu ((info->port == FM2_DTSEC10) && (PORT_IS_ENABLED(FM2_10GEC2))) || 255*ae8a5d10SShengzhou Liu ((info->port == FM2_10GEC1) && (PORT_IS_ENABLED(FM2_DTSEC9))) || 256*ae8a5d10SShengzhou Liu ((info->port == FM2_10GEC2) && (PORT_IS_ENABLED(FM2_DTSEC10))) 257*ae8a5d10SShengzhou Liu #endif 258*ae8a5d10SShengzhou Liu ) 259*ae8a5d10SShengzhou Liu return; 260*ae8a5d10SShengzhou Liu #endif 261c916d7c9SKumar Gala /* board code might have caused offset to change */ 262c916d7c9SKumar Gala off = fdt_node_offset_by_compat_reg(blob, prop, paddr); 263c916d7c9SKumar Gala 264e81c0abaSKumar Gala /* Don't disable FM1-DTSEC1 MAC as its used for MDIO */ 2654376b4c0STimur Tabi if (paddr != dtsec1_addr) 2664376b4c0STimur Tabi fdt_status_disabled(blob, off); /* disable the MAC node */ 267c916d7c9SKumar Gala 2684376b4c0STimur Tabi /* disable the fsl,dpa-ethernet node that points to the MAC */ 269c916d7c9SKumar Gala ph = fdt_get_phandle(blob, off); 270c916d7c9SKumar Gala do_fixup_by_prop(blob, "fsl,fman-mac", &ph, sizeof(ph), 271c916d7c9SKumar Gala "status", "disabled", strlen("disabled") + 1, 1); 272c916d7c9SKumar Gala } 273c916d7c9SKumar Gala 274c916d7c9SKumar Gala void fdt_fixup_fman_ethernet(void *blob) 275c916d7c9SKumar Gala { 276c916d7c9SKumar Gala int i; 277c916d7c9SKumar Gala 278*ae8a5d10SShengzhou Liu #ifdef CONFIG_SYS_FMAN_V3 279*ae8a5d10SShengzhou Liu for (i = 0; i < ARRAY_SIZE(fm_info); i++) 280*ae8a5d10SShengzhou Liu ft_fixup_port(blob, &fm_info[i], "fsl,fman-memac"); 281*ae8a5d10SShengzhou Liu #else 282c916d7c9SKumar Gala for (i = 0; i < ARRAY_SIZE(fm_info); i++) { 283c916d7c9SKumar Gala if (fm_info[i].type == FM_ETH_1G_E) 284c916d7c9SKumar Gala ft_fixup_port(blob, &fm_info[i], "fsl,fman-1g-mac"); 285c916d7c9SKumar Gala else 286c916d7c9SKumar Gala ft_fixup_port(blob, &fm_info[i], "fsl,fman-10g-mac"); 287c916d7c9SKumar Gala } 288*ae8a5d10SShengzhou Liu #endif 289c916d7c9SKumar Gala } 290