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