Home | History | Annotate | Download | only in ldpaa_eth 
      1 // SPDX-License-Identifier: GPL-2.0+
      2 /*
      3  * Copyright (C) 2015 Freescale Semiconductor
      4  */
      5 
      6 #include <common.h>
      7 #include <asm/io.h>
      8 #include <asm/types.h>
      9 #include <malloc.h>
     10 #include <net.h>
     11 #include <linux/compat.h>
     12 #include <asm/arch/fsl_serdes.h>
     13 #include <fsl-mc/ldpaa_wriop.h>
     14 
     15 struct wriop_dpmac_info dpmac_info[NUM_WRIOP_PORTS];
     16 
     17 __weak phy_interface_t wriop_dpmac_enet_if(int dpmac_id, int lane_prtc)
     18 {
     19 	return PHY_INTERFACE_MODE_NONE;
     20 }
     21 
     22 void wriop_init_dpmac(int sd, int dpmac_id, int lane_prtcl)
     23 {
     24 	phy_interface_t enet_if;
     25 
     26 	dpmac_info[dpmac_id].enabled = 0;
     27 	dpmac_info[dpmac_id].id = 0;
     28 	dpmac_info[dpmac_id].phy_addr = -1;
     29 	dpmac_info[dpmac_id].enet_if = PHY_INTERFACE_MODE_NONE;
     30 
     31 	enet_if = wriop_dpmac_enet_if(dpmac_id, lane_prtcl);
     32 	if (enet_if != PHY_INTERFACE_MODE_NONE) {
     33 		dpmac_info[dpmac_id].enabled = 1;
     34 		dpmac_info[dpmac_id].id = dpmac_id;
     35 		dpmac_info[dpmac_id].enet_if = enet_if;
     36 	}
     37 }
     38 
     39 void wriop_init_dpmac_enet_if(int dpmac_id, phy_interface_t enet_if)
     40 {
     41 	dpmac_info[dpmac_id].enabled = 1;
     42 	dpmac_info[dpmac_id].id = dpmac_id;
     43 	dpmac_info[dpmac_id].phy_addr = -1;
     44 	dpmac_info[dpmac_id].enet_if = enet_if;
     45 }
     46 
     47 
     48 /*TODO what it do */
     49 static int wriop_dpmac_to_index(int dpmac_id)
     50 {
     51 	int i;
     52 
     53 	for (i = WRIOP1_DPMAC1; i < NUM_WRIOP_PORTS; i++) {
     54 		if (dpmac_info[i].id == dpmac_id)
     55 			return i;
     56 	}
     57 
     58 	return -1;
     59 }
     60 
     61 void wriop_disable_dpmac(int dpmac_id)
     62 {
     63 	int i = wriop_dpmac_to_index(dpmac_id);
     64 
     65 	if (i == -1)
     66 		return;
     67 
     68 	dpmac_info[i].enabled = 0;
     69 	wriop_dpmac_disable(dpmac_id);
     70 }
     71 
     72 void wriop_enable_dpmac(int dpmac_id)
     73 {
     74 	int i = wriop_dpmac_to_index(dpmac_id);
     75 
     76 	if (i == -1)
     77 		return;
     78 
     79 	dpmac_info[i].enabled = 1;
     80 	wriop_dpmac_enable(dpmac_id);
     81 }
     82 
     83 u8 wriop_is_enabled_dpmac(int dpmac_id)
     84 {
     85 	int i = wriop_dpmac_to_index(dpmac_id);
     86 
     87 	if (i == -1)
     88 		return -1;
     89 
     90 	return dpmac_info[i].enabled;
     91 }
     92 
     93 
     94 void wriop_set_mdio(int dpmac_id, struct mii_dev *bus)
     95 {
     96 	int i = wriop_dpmac_to_index(dpmac_id);
     97 
     98 	if (i == -1)
     99 		return;
    100 
    101 	dpmac_info[i].bus = bus;
    102 }
    103 
    104 struct mii_dev *wriop_get_mdio(int dpmac_id)
    105 {
    106 	int i = wriop_dpmac_to_index(dpmac_id);
    107 
    108 	if (i == -1)
    109 		return NULL;
    110 
    111 	return dpmac_info[i].bus;
    112 }
    113 
    114 void wriop_set_phy_address(int dpmac_id, int address)
    115 {
    116 	int i = wriop_dpmac_to_index(dpmac_id);
    117 
    118 	if (i == -1)
    119 		return;
    120 
    121 	dpmac_info[i].phy_addr = address;
    122 }
    123 
    124 int wriop_get_phy_address(int dpmac_id)
    125 {
    126 	int i = wriop_dpmac_to_index(dpmac_id);
    127 
    128 	if (i == -1)
    129 		return -1;
    130 
    131 	return dpmac_info[i].phy_addr;
    132 }
    133 
    134 void wriop_set_phy_dev(int dpmac_id, struct phy_device *phydev)
    135 {
    136 	int i = wriop_dpmac_to_index(dpmac_id);
    137 
    138 	if (i == -1)
    139 		return;
    140 
    141 	dpmac_info[i].phydev = phydev;
    142 }
    143 
    144 struct phy_device *wriop_get_phy_dev(int dpmac_id)
    145 {
    146 	int i = wriop_dpmac_to_index(dpmac_id);
    147 
    148 	if (i == -1)
    149 		return NULL;
    150 
    151 	return dpmac_info[i].phydev;
    152 }
    153 
    154 phy_interface_t wriop_get_enet_if(int dpmac_id)
    155 {
    156 	int i = wriop_dpmac_to_index(dpmac_id);
    157 
    158 	if (i == -1)
    159 		return PHY_INTERFACE_MODE_NONE;
    160 
    161 	if (dpmac_info[i].enabled)
    162 		return dpmac_info[i].enet_if;
    163 
    164 	return PHY_INTERFACE_MODE_NONE;
    165 }
    166