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 41c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM2_DTSEC >= 1) 42c916d7c9SKumar Gala FM_DTSEC_INFO_INITIALIZER(2, 1), 43c916d7c9SKumar Gala #endif 44c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM2_DTSEC >= 2) 45c916d7c9SKumar Gala FM_DTSEC_INFO_INITIALIZER(2, 2), 46c916d7c9SKumar Gala #endif 47c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM2_DTSEC >= 3) 48c916d7c9SKumar Gala FM_DTSEC_INFO_INITIALIZER(2, 3), 49c916d7c9SKumar Gala #endif 50c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM2_DTSEC >= 4) 51c916d7c9SKumar Gala FM_DTSEC_INFO_INITIALIZER(2, 4), 52c916d7c9SKumar Gala #endif 53c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM1_10GEC >= 1) 54c916d7c9SKumar Gala FM_TGEC_INFO_INITIALIZER(1, 1), 55c916d7c9SKumar Gala #endif 56c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FM2_10GEC >= 1) 57c916d7c9SKumar Gala FM_TGEC_INFO_INITIALIZER(2, 1), 58c916d7c9SKumar Gala #endif 59c916d7c9SKumar Gala }; 60c916d7c9SKumar Gala 61c916d7c9SKumar Gala int fm_standard_init(bd_t *bis) 62c916d7c9SKumar Gala { 63c916d7c9SKumar Gala int i; 64c916d7c9SKumar Gala struct ccsr_fman *reg; 65c916d7c9SKumar Gala 66c916d7c9SKumar Gala reg = (void *)CONFIG_SYS_FSL_FM1_ADDR; 67c916d7c9SKumar Gala if (fm_init_common(0, reg)) 68c916d7c9SKumar Gala return 0; 69c916d7c9SKumar Gala 70c916d7c9SKumar Gala for (i = 0; i < ARRAY_SIZE(fm_info); i++) { 71c916d7c9SKumar Gala if ((fm_info[i].enabled) && (fm_info[i].index == 1)) 72c916d7c9SKumar Gala fm_eth_initialize(reg, &fm_info[i]); 73c916d7c9SKumar Gala } 74c916d7c9SKumar Gala 75c916d7c9SKumar Gala #if (CONFIG_SYS_NUM_FMAN == 2) 76c916d7c9SKumar Gala reg = (void *)CONFIG_SYS_FSL_FM2_ADDR; 77c916d7c9SKumar Gala if (fm_init_common(1, reg)) 78c916d7c9SKumar Gala return 0; 79c916d7c9SKumar Gala 80c916d7c9SKumar Gala for (i = 0; i < ARRAY_SIZE(fm_info); i++) { 81c916d7c9SKumar Gala if ((fm_info[i].enabled) && (fm_info[i].index == 2)) 82c916d7c9SKumar Gala fm_eth_initialize(reg, &fm_info[i]); 83c916d7c9SKumar Gala } 84c916d7c9SKumar Gala #endif 85c916d7c9SKumar Gala 86c916d7c9SKumar Gala return 1; 87c916d7c9SKumar Gala } 88c916d7c9SKumar Gala 89c916d7c9SKumar Gala /* simple linear search to map from port to array index */ 90c916d7c9SKumar Gala static int fm_port_to_index(enum fm_port port) 91c916d7c9SKumar Gala { 92c916d7c9SKumar Gala int i; 93c916d7c9SKumar Gala 94c916d7c9SKumar Gala for (i = 0; i < ARRAY_SIZE(fm_info); i++) { 95c916d7c9SKumar Gala if (fm_info[i].port == port) 96c916d7c9SKumar Gala return i; 97c916d7c9SKumar Gala } 98c916d7c9SKumar Gala 99c916d7c9SKumar Gala return -1; 100c916d7c9SKumar Gala } 101c916d7c9SKumar Gala 102c916d7c9SKumar Gala /* 103c916d7c9SKumar Gala * Determine if an interface is actually active based on HW config 104c916d7c9SKumar Gala * we expect fman_port_enet_if() to report PHY_INTERFACE_MODE_NONE if 105c916d7c9SKumar Gala * the interface is not active based on HW cfg of the SoC 106c916d7c9SKumar Gala */ 107c916d7c9SKumar Gala void fman_enet_init(void) 108c916d7c9SKumar Gala { 109c916d7c9SKumar Gala int i; 110c916d7c9SKumar Gala 111c916d7c9SKumar Gala for (i = 0; i < ARRAY_SIZE(fm_info); i++) { 112c916d7c9SKumar Gala phy_interface_t enet_if; 113c916d7c9SKumar Gala 114c916d7c9SKumar Gala enet_if = fman_port_enet_if(fm_info[i].port); 115c916d7c9SKumar Gala if (enet_if != PHY_INTERFACE_MODE_NONE) { 116c916d7c9SKumar Gala fm_info[i].enabled = 1; 117c916d7c9SKumar Gala fm_info[i].enet_if = enet_if; 118c916d7c9SKumar Gala } else { 119c916d7c9SKumar Gala fm_info[i].enabled = 0; 120c916d7c9SKumar Gala } 121c916d7c9SKumar Gala } 122c916d7c9SKumar Gala 123c916d7c9SKumar Gala return ; 124c916d7c9SKumar Gala } 125c916d7c9SKumar Gala 12669a85242SKumar Gala void fm_disable_port(enum fm_port port) 12769a85242SKumar Gala { 12869a85242SKumar Gala int i = fm_port_to_index(port); 12969a85242SKumar Gala 13069a85242SKumar Gala fm_info[i].enabled = 0; 13169a85242SKumar Gala fman_disable_port(port); 13269a85242SKumar Gala } 13369a85242SKumar Gala 134c916d7c9SKumar Gala void fm_info_set_mdio(enum fm_port port, struct mii_dev *bus) 135c916d7c9SKumar Gala { 136c916d7c9SKumar Gala int i = fm_port_to_index(port); 137c916d7c9SKumar Gala 138c916d7c9SKumar Gala if (i == -1) 139c916d7c9SKumar Gala return; 140c916d7c9SKumar Gala 141c916d7c9SKumar Gala fm_info[i].bus = bus; 142c916d7c9SKumar Gala } 143c916d7c9SKumar Gala 144c916d7c9SKumar Gala void fm_info_set_phy_address(enum fm_port port, int address) 145c916d7c9SKumar Gala { 146c916d7c9SKumar Gala int i = fm_port_to_index(port); 147c916d7c9SKumar Gala 148c916d7c9SKumar Gala if (i == -1) 149c916d7c9SKumar Gala return; 150c916d7c9SKumar Gala 151c916d7c9SKumar Gala fm_info[i].phy_addr = address; 152c916d7c9SKumar Gala } 153c916d7c9SKumar Gala 154c916d7c9SKumar Gala /* 155c916d7c9SKumar Gala * Returns the type of the data interface between the given MAC and its PHY. 156c916d7c9SKumar Gala * This is typically determined by the RCW. 157c916d7c9SKumar Gala */ 158c916d7c9SKumar Gala phy_interface_t fm_info_get_enet_if(enum fm_port port) 159c916d7c9SKumar Gala { 160c916d7c9SKumar Gala int i = fm_port_to_index(port); 161c916d7c9SKumar Gala 162c916d7c9SKumar Gala if (i == -1) 163c916d7c9SKumar Gala return PHY_INTERFACE_MODE_NONE; 164c916d7c9SKumar Gala 165c916d7c9SKumar Gala if (fm_info[i].enabled) 166c916d7c9SKumar Gala return fm_info[i].enet_if; 167c916d7c9SKumar Gala 168c916d7c9SKumar Gala return PHY_INTERFACE_MODE_NONE; 169c916d7c9SKumar Gala } 170c916d7c9SKumar Gala 171c916d7c9SKumar Gala static void 172c916d7c9SKumar Gala __def_board_ft_fman_fixup_port(void *blob, char * prop, phys_addr_t pa, 173c916d7c9SKumar Gala enum fm_port port, int offset) 174c916d7c9SKumar Gala { 175c916d7c9SKumar Gala return ; 176c916d7c9SKumar Gala } 177c916d7c9SKumar Gala 178c916d7c9SKumar Gala void board_ft_fman_fixup_port(void *blob, char * prop, phys_addr_t pa, 179c916d7c9SKumar Gala enum fm_port port, int offset) 180c916d7c9SKumar Gala __attribute__((weak, alias("__def_board_ft_fman_fixup_port"))); 181c916d7c9SKumar Gala 182c916d7c9SKumar Gala static void ft_fixup_port(void *blob, struct fm_eth_info *info, char *prop) 183c916d7c9SKumar Gala { 184c916d7c9SKumar Gala int off, ph; 185c916d7c9SKumar Gala phys_addr_t paddr = CONFIG_SYS_CCSRBAR_PHYS + info->compat_offset; 186*e81c0abaSKumar Gala u64 dtsec1_addr = (u64)CONFIG_SYS_CCSRBAR_PHYS + 187*e81c0abaSKumar Gala CONFIG_SYS_FSL_FM1_DTSEC1_OFFSET; 188c916d7c9SKumar Gala 189c916d7c9SKumar Gala off = fdt_node_offset_by_compat_reg(blob, prop, paddr); 190c916d7c9SKumar Gala 191c916d7c9SKumar Gala if (info->enabled) { 192c916d7c9SKumar Gala fdt_fixup_phy_connection(blob, off, info->enet_if); 193c916d7c9SKumar Gala board_ft_fman_fixup_port(blob, prop, paddr, info->port, off); 194c916d7c9SKumar Gala return ; 195c916d7c9SKumar Gala } 196c916d7c9SKumar Gala 197c916d7c9SKumar Gala /* board code might have caused offset to change */ 198c916d7c9SKumar Gala off = fdt_node_offset_by_compat_reg(blob, prop, paddr); 199c916d7c9SKumar Gala 200*e81c0abaSKumar Gala /* Don't disable FM1-DTSEC1 MAC as its used for MDIO */ 201*e81c0abaSKumar Gala if (paddr != dtsec1_addr) { 202*e81c0abaSKumar Gala /* disable the mac node */ 203c916d7c9SKumar Gala fdt_setprop_string(blob, off, "status", "disabled"); 204*e81c0abaSKumar Gala } 205c916d7c9SKumar Gala 206*e81c0abaSKumar Gala /* disable the node point to the mac */ 207c916d7c9SKumar Gala ph = fdt_get_phandle(blob, off); 208c916d7c9SKumar Gala do_fixup_by_prop(blob, "fsl,fman-mac", &ph, sizeof(ph), 209c916d7c9SKumar Gala "status", "disabled", strlen("disabled") + 1, 1); 210c916d7c9SKumar Gala } 211c916d7c9SKumar Gala 212c916d7c9SKumar Gala void fdt_fixup_fman_ethernet(void *blob) 213c916d7c9SKumar Gala { 214c916d7c9SKumar Gala int i; 215c916d7c9SKumar Gala 216c916d7c9SKumar Gala for (i = 0; i < ARRAY_SIZE(fm_info); i++) { 217c916d7c9SKumar Gala if (fm_info[i].type == FM_ETH_1G_E) 218c916d7c9SKumar Gala ft_fixup_port(blob, &fm_info[i], "fsl,fman-1g-mac"); 219c916d7c9SKumar Gala else 220c916d7c9SKumar Gala ft_fixup_port(blob, &fm_info[i], "fsl,fman-10g-mac"); 221c916d7c9SKumar Gala } 222c916d7c9SKumar Gala } 223