1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
|
/*
* Copyright 2017 NXP
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* as published by the Free Software Foundation; either version 2
* of the License, or (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*/
#include <linux/netdevice.h>
#include <linux/phy.h>
#include <linux/of.h>
#include <linux/of_address.h>
#ifdef CONFIG_ARCH_MXC_ARM64
#include <soc/imx8/sc/sci.h>
#endif
#include "fec.h"
#define PHY_ID_AR8031 0x004dd074
#define IMX8QM_FUSE_MAC0_WORD0 452
#define IMX8QM_FUSE_MAC0_WORD1 453
#define IMX8QM_FUSE_MAC1_WORD0 454
#define IMX8QM_FUSE_MAC1_WORD1 455
#define IMX8QXP_FUSE_MAC0_WORD0 708
#define IMX8QXP_FUSE_MAC0_WORD1 709
#define IMX8QXP_FUSE_MAC1_WORD0 710
#define IMX8QXP_FUSE_MAC1_WORD1 711
#define IMX8M_OCOTP_MAC_ADDR0_OFF 0x640
#define IMX8M_OCOTP_MAC_ADDR1_OFF 0x650
enum imx_soc_type {
IMX8QM_FUSE = 0,
IMX8QXP_FUSE,
};
struct imx_fuse_mac_addr {
u32 fuse_mac0_word0;
u32 fuse_mac0_word1;
u32 fuse_mac1_word0;
u32 fuse_mac1_word1;
};
static struct imx_fuse_mac_addr imx8_fuse_mapping[] = {
{
.fuse_mac0_word0 = IMX8QM_FUSE_MAC0_WORD0,
.fuse_mac0_word1 = IMX8QM_FUSE_MAC0_WORD1,
.fuse_mac1_word0 = IMX8QM_FUSE_MAC1_WORD0,
.fuse_mac1_word1 = IMX8QM_FUSE_MAC1_WORD1,
}, {
.fuse_mac0_word0 = IMX8QXP_FUSE_MAC0_WORD0,
.fuse_mac0_word1 = IMX8QXP_FUSE_MAC0_WORD1,
.fuse_mac1_word0 = IMX8QXP_FUSE_MAC1_WORD0,
.fuse_mac1_word1 = IMX8QXP_FUSE_MAC1_WORD1,
}, {
/* sentinel */
}
};
static int ar8031_phy_fixup(struct phy_device *dev)
{
u16 val;
/* Set RGMII IO voltage to 1.8V */
phy_write(dev, 0x1d, 0x1f);
phy_write(dev, 0x1e, 0x8);
/* Disable phy AR8031 SmartEEE function */
phy_write(dev, 0xd, 0x3);
phy_write(dev, 0xe, 0x805d);
phy_write(dev, 0xd, 0x4003);
val = phy_read(dev, 0xe);
val &= ~(0x1 << 8);
phy_write(dev, 0xe, val);
/* Introduce tx clock delay */
phy_write(dev, 0x1d, 0x5);
phy_write(dev, 0x1e, 0x100);
return 0;
}
void fec_enet_register_fixup(struct net_device *ndev)
{
struct fec_enet_private *fep = netdev_priv(ndev);
int err;
if (!IS_BUILTIN(CONFIG_PHYLIB))
return;
if (fep->fixups & FEC_QUIRK_AR8031_FIXUP) {
static int ar8031_registered = 0;
if (ar8031_registered)
return;
err = phy_register_fixup_for_uid(PHY_ID_AR8031, 0xffffffef,
ar8031_phy_fixup);
if (err)
netdev_info(ndev, "Cannot register PHY board fixup\n");
ar8031_registered = 1;
}
}
int of_fec_enet_parse_fixup(struct device_node *np)
{
int fixups = 0;
if (of_get_property(np, "fsl,ar8031-phy-fixup", NULL))
fixups |= FEC_QUIRK_AR8031_FIXUP;
return fixups;
}
static void imx8mq_get_mac_from_fuse(int dev_id, unsigned char *mac)
{
struct device_node *ocotp_np;
void __iomem *base;
u32 value;
ocotp_np = of_find_compatible_node(NULL, NULL, "fsl,imx7d-ocotp");
if (!ocotp_np) {
pr_warn("failed to find ocotp node\n");
return;
}
base = of_iomap(ocotp_np, 0);
if (!base) {
pr_warn("failed to map ocotp\n");
goto put_ocotp_node;
}
value = readl_relaxed(base + IMX8M_OCOTP_MAC_ADDR1_OFF);
mac[0] = (value >> 8);
mac[1] = value;
value = readl_relaxed(base + IMX8M_OCOTP_MAC_ADDR0_OFF);
mac[2] = value >> 24;
mac[3] = value >> 16;
mac[4] = value >> 8;
mac[5] = value;
put_ocotp_node:
of_node_put(ocotp_np);
}
#ifdef CONFIG_ARCH_MXC_ARM64
static void imx8qm_get_mac_from_fuse(int dev_id, unsigned char *mac,
struct imx_fuse_mac_addr *fuse_mapping)
{
uint32_t mu_id;
sc_ipc_t ipc_handle;
sc_err_t sc_err = SC_ERR_NONE;
uint32_t val1 = 0, val2 = 0;
uint32_t word1, word2;
sc_err = sc_ipc_getMuID(&mu_id);
if (sc_err != SC_ERR_NONE) {
pr_err("FEC MAC fuse: Get MU ID failed\n");
return;
}
sc_err = sc_ipc_open(&ipc_handle, mu_id);
if (sc_err != SC_ERR_NONE) {
pr_err("FEC MAC fuse: Open MU channel failed\n");
return;
}
if (dev_id == 0) {
word1 = fuse_mapping->fuse_mac0_word0;
word2 = fuse_mapping->fuse_mac0_word1;
} else {
word1 = fuse_mapping->fuse_mac1_word0;
word2 = fuse_mapping->fuse_mac1_word1;
}
sc_err = sc_misc_otp_fuse_read(ipc_handle, word1, &val1);
if (sc_err != SC_ERR_NONE) {
pr_err("FEC MAC fuse %d read error: %d\n", word1, sc_err);
return;
}
sc_err = sc_misc_otp_fuse_read(ipc_handle, word2, &val2);
if (sc_err != SC_ERR_NONE) {
pr_err("FEC MAC fuse %d read error: %d\n", word2, sc_err);
return;
}
mac[0] = val1;
mac[1] = val1 >> 8;
mac[2] = val1 >> 16;
mac[3] = val1 >> 24;
mac[4] = val2;
mac[5] = val2 >> 8;
}
#else
static void imx8qm_get_mac_from_fuse(int dev_id, unsigned char *mac,
struct imx_fuse_mac_addr *fuse_mapping) {}
#endif
void fec_enet_get_mac_from_fuse(struct device_node *np, unsigned char *mac)
{
int idx;
if (!np)
return;
idx = of_alias_get_id(np, "ethernet");
if (idx < 0)
idx = 0;
if (of_machine_is_compatible("fsl,imx8qm"))
imx8qm_get_mac_from_fuse(idx, mac,
&imx8_fuse_mapping[IMX8QM_FUSE]);
else if (of_machine_is_compatible("fsl,imx8qxp"))
imx8qm_get_mac_from_fuse(idx, mac,
&imx8_fuse_mapping[IMX8QXP_FUSE]);
else if (of_machine_is_compatible("fsl,imx8mq"))
imx8mq_get_mac_from_fuse(idx, mac);
}
|
