Loading...
1/*
2 * Driver for the Texas Instruments DP83822 PHY
3 *
4 * Copyright (C) 2017 Texas Instruments Inc.
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 */
15
16#include <linux/ethtool.h>
17#include <linux/etherdevice.h>
18#include <linux/kernel.h>
19#include <linux/mii.h>
20#include <linux/module.h>
21#include <linux/of.h>
22#include <linux/phy.h>
23#include <linux/netdevice.h>
24
25#define DP83822_PHY_ID 0x2000a240
26#define DP83822_DEVADDR 0x1f
27
28#define MII_DP83822_PHYSCR 0x11
29#define MII_DP83822_MISR1 0x12
30#define MII_DP83822_MISR2 0x13
31#define MII_DP83822_RESET_CTRL 0x1f
32
33#define DP83822_HW_RESET BIT(15)
34#define DP83822_SW_RESET BIT(14)
35
36/* PHYSCR Register Fields */
37#define DP83822_PHYSCR_INT_OE BIT(0) /* Interrupt Output Enable */
38#define DP83822_PHYSCR_INTEN BIT(1) /* Interrupt Enable */
39
40/* MISR1 bits */
41#define DP83822_RX_ERR_HF_INT_EN BIT(0)
42#define DP83822_FALSE_CARRIER_HF_INT_EN BIT(1)
43#define DP83822_ANEG_COMPLETE_INT_EN BIT(2)
44#define DP83822_DUP_MODE_CHANGE_INT_EN BIT(3)
45#define DP83822_SPEED_CHANGED_INT_EN BIT(4)
46#define DP83822_LINK_STAT_INT_EN BIT(5)
47#define DP83822_ENERGY_DET_INT_EN BIT(6)
48#define DP83822_LINK_QUAL_INT_EN BIT(7)
49
50/* MISR2 bits */
51#define DP83822_JABBER_DET_INT_EN BIT(0)
52#define DP83822_WOL_PKT_INT_EN BIT(1)
53#define DP83822_SLEEP_MODE_INT_EN BIT(2)
54#define DP83822_MDI_XOVER_INT_EN BIT(3)
55#define DP83822_LB_FIFO_INT_EN BIT(4)
56#define DP83822_PAGE_RX_INT_EN BIT(5)
57#define DP83822_ANEG_ERR_INT_EN BIT(6)
58#define DP83822_EEE_ERROR_CHANGE_INT_EN BIT(7)
59
60/* INT_STAT1 bits */
61#define DP83822_WOL_INT_EN BIT(4)
62#define DP83822_WOL_INT_STAT BIT(12)
63
64#define MII_DP83822_RXSOP1 0x04a5
65#define MII_DP83822_RXSOP2 0x04a6
66#define MII_DP83822_RXSOP3 0x04a7
67
68/* WoL Registers */
69#define MII_DP83822_WOL_CFG 0x04a0
70#define MII_DP83822_WOL_STAT 0x04a1
71#define MII_DP83822_WOL_DA1 0x04a2
72#define MII_DP83822_WOL_DA2 0x04a3
73#define MII_DP83822_WOL_DA3 0x04a4
74
75/* WoL bits */
76#define DP83822_WOL_MAGIC_EN BIT(0)
77#define DP83822_WOL_SECURE_ON BIT(5)
78#define DP83822_WOL_EN BIT(7)
79#define DP83822_WOL_INDICATION_SEL BIT(8)
80#define DP83822_WOL_CLR_INDICATION BIT(11)
81
82static int dp83822_ack_interrupt(struct phy_device *phydev)
83{
84 int err;
85
86 err = phy_read(phydev, MII_DP83822_MISR1);
87 if (err < 0)
88 return err;
89
90 err = phy_read(phydev, MII_DP83822_MISR2);
91 if (err < 0)
92 return err;
93
94 return 0;
95}
96
97static int dp83822_set_wol(struct phy_device *phydev,
98 struct ethtool_wolinfo *wol)
99{
100 struct net_device *ndev = phydev->attached_dev;
101 u16 value;
102 const u8 *mac;
103
104 if (wol->wolopts & (WAKE_MAGIC | WAKE_MAGICSECURE)) {
105 mac = (const u8 *)ndev->dev_addr;
106
107 if (!is_valid_ether_addr(mac))
108 return -EINVAL;
109
110 /* MAC addresses start with byte 5, but stored in mac[0].
111 * 822 PHYs store bytes 4|5, 2|3, 0|1
112 */
113 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_DA1,
114 (mac[1] << 8) | mac[0]);
115 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_DA2,
116 (mac[3] << 8) | mac[2]);
117 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_DA3,
118 (mac[5] << 8) | mac[4]);
119
120 value = phy_read_mmd(phydev, DP83822_DEVADDR,
121 MII_DP83822_WOL_CFG);
122 if (wol->wolopts & WAKE_MAGIC)
123 value |= DP83822_WOL_MAGIC_EN;
124 else
125 value &= ~DP83822_WOL_MAGIC_EN;
126
127 if (wol->wolopts & WAKE_MAGICSECURE) {
128 phy_write_mmd(phydev, DP83822_DEVADDR,
129 MII_DP83822_RXSOP1,
130 (wol->sopass[1] << 8) | wol->sopass[0]);
131 phy_write_mmd(phydev, DP83822_DEVADDR,
132 MII_DP83822_RXSOP2,
133 (wol->sopass[3] << 8) | wol->sopass[2]);
134 phy_write_mmd(phydev, DP83822_DEVADDR,
135 MII_DP83822_RXSOP3,
136 (wol->sopass[5] << 8) | wol->sopass[4]);
137 value |= DP83822_WOL_SECURE_ON;
138 } else {
139 value &= ~DP83822_WOL_SECURE_ON;
140 }
141
142 value |= (DP83822_WOL_EN | DP83822_WOL_INDICATION_SEL |
143 DP83822_WOL_CLR_INDICATION);
144 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG,
145 value);
146 } else {
147 value = phy_read_mmd(phydev, DP83822_DEVADDR,
148 MII_DP83822_WOL_CFG);
149 value &= ~DP83822_WOL_EN;
150 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG,
151 value);
152 }
153
154 return 0;
155}
156
157static void dp83822_get_wol(struct phy_device *phydev,
158 struct ethtool_wolinfo *wol)
159{
160 int value;
161 u16 sopass_val;
162
163 wol->supported = (WAKE_MAGIC | WAKE_MAGICSECURE);
164 wol->wolopts = 0;
165
166 value = phy_read_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG);
167
168 if (value & DP83822_WOL_MAGIC_EN)
169 wol->wolopts |= WAKE_MAGIC;
170
171 if (value & DP83822_WOL_SECURE_ON) {
172 sopass_val = phy_read_mmd(phydev, DP83822_DEVADDR,
173 MII_DP83822_RXSOP1);
174 wol->sopass[0] = (sopass_val & 0xff);
175 wol->sopass[1] = (sopass_val >> 8);
176
177 sopass_val = phy_read_mmd(phydev, DP83822_DEVADDR,
178 MII_DP83822_RXSOP2);
179 wol->sopass[2] = (sopass_val & 0xff);
180 wol->sopass[3] = (sopass_val >> 8);
181
182 sopass_val = phy_read_mmd(phydev, DP83822_DEVADDR,
183 MII_DP83822_RXSOP3);
184 wol->sopass[4] = (sopass_val & 0xff);
185 wol->sopass[5] = (sopass_val >> 8);
186
187 wol->wolopts |= WAKE_MAGICSECURE;
188 }
189
190 /* WoL is not enabled so set wolopts to 0 */
191 if (!(value & DP83822_WOL_EN))
192 wol->wolopts = 0;
193}
194
195static int dp83822_config_intr(struct phy_device *phydev)
196{
197 int misr_status;
198 int physcr_status;
199 int err;
200
201 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
202 misr_status = phy_read(phydev, MII_DP83822_MISR1);
203 if (misr_status < 0)
204 return misr_status;
205
206 misr_status |= (DP83822_RX_ERR_HF_INT_EN |
207 DP83822_FALSE_CARRIER_HF_INT_EN |
208 DP83822_ANEG_COMPLETE_INT_EN |
209 DP83822_DUP_MODE_CHANGE_INT_EN |
210 DP83822_SPEED_CHANGED_INT_EN |
211 DP83822_LINK_STAT_INT_EN |
212 DP83822_ENERGY_DET_INT_EN |
213 DP83822_LINK_QUAL_INT_EN);
214
215 err = phy_write(phydev, MII_DP83822_MISR1, misr_status);
216 if (err < 0)
217 return err;
218
219 misr_status = phy_read(phydev, MII_DP83822_MISR2);
220 if (misr_status < 0)
221 return misr_status;
222
223 misr_status |= (DP83822_JABBER_DET_INT_EN |
224 DP83822_WOL_PKT_INT_EN |
225 DP83822_SLEEP_MODE_INT_EN |
226 DP83822_MDI_XOVER_INT_EN |
227 DP83822_LB_FIFO_INT_EN |
228 DP83822_PAGE_RX_INT_EN |
229 DP83822_ANEG_ERR_INT_EN |
230 DP83822_EEE_ERROR_CHANGE_INT_EN);
231
232 err = phy_write(phydev, MII_DP83822_MISR2, misr_status);
233 if (err < 0)
234 return err;
235
236 physcr_status = phy_read(phydev, MII_DP83822_PHYSCR);
237 if (physcr_status < 0)
238 return physcr_status;
239
240 physcr_status |= DP83822_PHYSCR_INT_OE | DP83822_PHYSCR_INTEN;
241
242 } else {
243 err = phy_write(phydev, MII_DP83822_MISR1, 0);
244 if (err < 0)
245 return err;
246
247 err = phy_write(phydev, MII_DP83822_MISR1, 0);
248 if (err < 0)
249 return err;
250
251 physcr_status = phy_read(phydev, MII_DP83822_PHYSCR);
252 if (physcr_status < 0)
253 return physcr_status;
254
255 physcr_status &= ~DP83822_PHYSCR_INTEN;
256 }
257
258 return phy_write(phydev, MII_DP83822_PHYSCR, physcr_status);
259}
260
261static int dp83822_config_init(struct phy_device *phydev)
262{
263 int err;
264 int value;
265
266 err = genphy_config_init(phydev);
267 if (err < 0)
268 return err;
269
270 value = DP83822_WOL_MAGIC_EN | DP83822_WOL_SECURE_ON | DP83822_WOL_EN;
271
272 return phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG,
273 value);
274}
275
276static int dp83822_phy_reset(struct phy_device *phydev)
277{
278 int err;
279
280 err = phy_write(phydev, MII_DP83822_RESET_CTRL, DP83822_HW_RESET);
281 if (err < 0)
282 return err;
283
284 dp83822_config_init(phydev);
285
286 return 0;
287}
288
289static int dp83822_suspend(struct phy_device *phydev)
290{
291 int value;
292
293 value = phy_read_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG);
294
295 if (!(value & DP83822_WOL_EN))
296 genphy_suspend(phydev);
297
298 return 0;
299}
300
301static int dp83822_resume(struct phy_device *phydev)
302{
303 int value;
304
305 genphy_resume(phydev);
306
307 value = phy_read_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG);
308
309 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG, value |
310 DP83822_WOL_CLR_INDICATION);
311
312 return 0;
313}
314
315static struct phy_driver dp83822_driver[] = {
316 {
317 .phy_id = DP83822_PHY_ID,
318 .phy_id_mask = 0xfffffff0,
319 .name = "TI DP83822",
320 .features = PHY_BASIC_FEATURES,
321 .flags = PHY_HAS_INTERRUPT,
322 .config_init = dp83822_config_init,
323 .soft_reset = dp83822_phy_reset,
324 .get_wol = dp83822_get_wol,
325 .set_wol = dp83822_set_wol,
326 .ack_interrupt = dp83822_ack_interrupt,
327 .config_intr = dp83822_config_intr,
328 .suspend = dp83822_suspend,
329 .resume = dp83822_resume,
330 },
331};
332module_phy_driver(dp83822_driver);
333
334static struct mdio_device_id __maybe_unused dp83822_tbl[] = {
335 { DP83822_PHY_ID, 0xfffffff0 },
336 { },
337};
338MODULE_DEVICE_TABLE(mdio, dp83822_tbl);
339
340MODULE_DESCRIPTION("Texas Instruments DP83822 PHY driver");
341MODULE_AUTHOR("Dan Murphy <dmurphy@ti.com");
342MODULE_LICENSE("GPL");
1// SPDX-License-Identifier: GPL-2.0
2/* Driver for the Texas Instruments DP83822, DP83825 and DP83826 PHYs.
3 *
4 * Copyright (C) 2017 Texas Instruments Inc.
5 */
6
7#include <linux/ethtool.h>
8#include <linux/etherdevice.h>
9#include <linux/kernel.h>
10#include <linux/mii.h>
11#include <linux/module.h>
12#include <linux/of.h>
13#include <linux/phy.h>
14#include <linux/netdevice.h>
15
16#define DP83822_PHY_ID 0x2000a240
17#define DP83825S_PHY_ID 0x2000a140
18#define DP83825I_PHY_ID 0x2000a150
19#define DP83825CM_PHY_ID 0x2000a160
20#define DP83825CS_PHY_ID 0x2000a170
21#define DP83826C_PHY_ID 0x2000a130
22#define DP83826NC_PHY_ID 0x2000a110
23
24#define DP83822_DEVADDR 0x1f
25
26#define MII_DP83822_PHYSCR 0x11
27#define MII_DP83822_MISR1 0x12
28#define MII_DP83822_MISR2 0x13
29#define MII_DP83822_RCSR 0x17
30#define MII_DP83822_RESET_CTRL 0x1f
31#define MII_DP83822_GENCFG 0x465
32
33#define DP83822_HW_RESET BIT(15)
34#define DP83822_SW_RESET BIT(14)
35
36/* PHYSCR Register Fields */
37#define DP83822_PHYSCR_INT_OE BIT(0) /* Interrupt Output Enable */
38#define DP83822_PHYSCR_INTEN BIT(1) /* Interrupt Enable */
39
40/* MISR1 bits */
41#define DP83822_RX_ERR_HF_INT_EN BIT(0)
42#define DP83822_FALSE_CARRIER_HF_INT_EN BIT(1)
43#define DP83822_ANEG_COMPLETE_INT_EN BIT(2)
44#define DP83822_DUP_MODE_CHANGE_INT_EN BIT(3)
45#define DP83822_SPEED_CHANGED_INT_EN BIT(4)
46#define DP83822_LINK_STAT_INT_EN BIT(5)
47#define DP83822_ENERGY_DET_INT_EN BIT(6)
48#define DP83822_LINK_QUAL_INT_EN BIT(7)
49
50/* MISR2 bits */
51#define DP83822_JABBER_DET_INT_EN BIT(0)
52#define DP83822_WOL_PKT_INT_EN BIT(1)
53#define DP83822_SLEEP_MODE_INT_EN BIT(2)
54#define DP83822_MDI_XOVER_INT_EN BIT(3)
55#define DP83822_LB_FIFO_INT_EN BIT(4)
56#define DP83822_PAGE_RX_INT_EN BIT(5)
57#define DP83822_ANEG_ERR_INT_EN BIT(6)
58#define DP83822_EEE_ERROR_CHANGE_INT_EN BIT(7)
59
60/* INT_STAT1 bits */
61#define DP83822_WOL_INT_EN BIT(4)
62#define DP83822_WOL_INT_STAT BIT(12)
63
64#define MII_DP83822_RXSOP1 0x04a5
65#define MII_DP83822_RXSOP2 0x04a6
66#define MII_DP83822_RXSOP3 0x04a7
67
68/* WoL Registers */
69#define MII_DP83822_WOL_CFG 0x04a0
70#define MII_DP83822_WOL_STAT 0x04a1
71#define MII_DP83822_WOL_DA1 0x04a2
72#define MII_DP83822_WOL_DA2 0x04a3
73#define MII_DP83822_WOL_DA3 0x04a4
74
75/* WoL bits */
76#define DP83822_WOL_MAGIC_EN BIT(0)
77#define DP83822_WOL_SECURE_ON BIT(5)
78#define DP83822_WOL_EN BIT(7)
79#define DP83822_WOL_INDICATION_SEL BIT(8)
80#define DP83822_WOL_CLR_INDICATION BIT(11)
81
82/* RSCR bits */
83#define DP83822_RX_CLK_SHIFT BIT(12)
84#define DP83822_TX_CLK_SHIFT BIT(11)
85
86static int dp83822_ack_interrupt(struct phy_device *phydev)
87{
88 int err;
89
90 err = phy_read(phydev, MII_DP83822_MISR1);
91 if (err < 0)
92 return err;
93
94 err = phy_read(phydev, MII_DP83822_MISR2);
95 if (err < 0)
96 return err;
97
98 return 0;
99}
100
101static int dp83822_set_wol(struct phy_device *phydev,
102 struct ethtool_wolinfo *wol)
103{
104 struct net_device *ndev = phydev->attached_dev;
105 u16 value;
106 const u8 *mac;
107
108 if (wol->wolopts & (WAKE_MAGIC | WAKE_MAGICSECURE)) {
109 mac = (const u8 *)ndev->dev_addr;
110
111 if (!is_valid_ether_addr(mac))
112 return -EINVAL;
113
114 /* MAC addresses start with byte 5, but stored in mac[0].
115 * 822 PHYs store bytes 4|5, 2|3, 0|1
116 */
117 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_DA1,
118 (mac[1] << 8) | mac[0]);
119 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_DA2,
120 (mac[3] << 8) | mac[2]);
121 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_DA3,
122 (mac[5] << 8) | mac[4]);
123
124 value = phy_read_mmd(phydev, DP83822_DEVADDR,
125 MII_DP83822_WOL_CFG);
126 if (wol->wolopts & WAKE_MAGIC)
127 value |= DP83822_WOL_MAGIC_EN;
128 else
129 value &= ~DP83822_WOL_MAGIC_EN;
130
131 if (wol->wolopts & WAKE_MAGICSECURE) {
132 phy_write_mmd(phydev, DP83822_DEVADDR,
133 MII_DP83822_RXSOP1,
134 (wol->sopass[1] << 8) | wol->sopass[0]);
135 phy_write_mmd(phydev, DP83822_DEVADDR,
136 MII_DP83822_RXSOP2,
137 (wol->sopass[3] << 8) | wol->sopass[2]);
138 phy_write_mmd(phydev, DP83822_DEVADDR,
139 MII_DP83822_RXSOP3,
140 (wol->sopass[5] << 8) | wol->sopass[4]);
141 value |= DP83822_WOL_SECURE_ON;
142 } else {
143 value &= ~DP83822_WOL_SECURE_ON;
144 }
145
146 /* Clear any pending WoL interrupt */
147 phy_read(phydev, MII_DP83822_MISR2);
148
149 value |= DP83822_WOL_EN | DP83822_WOL_INDICATION_SEL |
150 DP83822_WOL_CLR_INDICATION;
151
152 return phy_write_mmd(phydev, DP83822_DEVADDR,
153 MII_DP83822_WOL_CFG, value);
154 } else {
155 return phy_clear_bits_mmd(phydev, DP83822_DEVADDR,
156 MII_DP83822_WOL_CFG, DP83822_WOL_EN);
157 }
158}
159
160static void dp83822_get_wol(struct phy_device *phydev,
161 struct ethtool_wolinfo *wol)
162{
163 int value;
164 u16 sopass_val;
165
166 wol->supported = (WAKE_MAGIC | WAKE_MAGICSECURE);
167 wol->wolopts = 0;
168
169 value = phy_read_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG);
170
171 if (value & DP83822_WOL_MAGIC_EN)
172 wol->wolopts |= WAKE_MAGIC;
173
174 if (value & DP83822_WOL_SECURE_ON) {
175 sopass_val = phy_read_mmd(phydev, DP83822_DEVADDR,
176 MII_DP83822_RXSOP1);
177 wol->sopass[0] = (sopass_val & 0xff);
178 wol->sopass[1] = (sopass_val >> 8);
179
180 sopass_val = phy_read_mmd(phydev, DP83822_DEVADDR,
181 MII_DP83822_RXSOP2);
182 wol->sopass[2] = (sopass_val & 0xff);
183 wol->sopass[3] = (sopass_val >> 8);
184
185 sopass_val = phy_read_mmd(phydev, DP83822_DEVADDR,
186 MII_DP83822_RXSOP3);
187 wol->sopass[4] = (sopass_val & 0xff);
188 wol->sopass[5] = (sopass_val >> 8);
189
190 wol->wolopts |= WAKE_MAGICSECURE;
191 }
192
193 /* WoL is not enabled so set wolopts to 0 */
194 if (!(value & DP83822_WOL_EN))
195 wol->wolopts = 0;
196}
197
198static int dp83822_config_intr(struct phy_device *phydev)
199{
200 int misr_status;
201 int physcr_status;
202 int err;
203
204 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
205 misr_status = phy_read(phydev, MII_DP83822_MISR1);
206 if (misr_status < 0)
207 return misr_status;
208
209 misr_status |= (DP83822_RX_ERR_HF_INT_EN |
210 DP83822_FALSE_CARRIER_HF_INT_EN |
211 DP83822_ANEG_COMPLETE_INT_EN |
212 DP83822_DUP_MODE_CHANGE_INT_EN |
213 DP83822_SPEED_CHANGED_INT_EN |
214 DP83822_LINK_STAT_INT_EN |
215 DP83822_ENERGY_DET_INT_EN |
216 DP83822_LINK_QUAL_INT_EN);
217
218 err = phy_write(phydev, MII_DP83822_MISR1, misr_status);
219 if (err < 0)
220 return err;
221
222 misr_status = phy_read(phydev, MII_DP83822_MISR2);
223 if (misr_status < 0)
224 return misr_status;
225
226 misr_status |= (DP83822_JABBER_DET_INT_EN |
227 DP83822_WOL_PKT_INT_EN |
228 DP83822_SLEEP_MODE_INT_EN |
229 DP83822_MDI_XOVER_INT_EN |
230 DP83822_LB_FIFO_INT_EN |
231 DP83822_PAGE_RX_INT_EN |
232 DP83822_ANEG_ERR_INT_EN |
233 DP83822_EEE_ERROR_CHANGE_INT_EN);
234
235 err = phy_write(phydev, MII_DP83822_MISR2, misr_status);
236 if (err < 0)
237 return err;
238
239 physcr_status = phy_read(phydev, MII_DP83822_PHYSCR);
240 if (physcr_status < 0)
241 return physcr_status;
242
243 physcr_status |= DP83822_PHYSCR_INT_OE | DP83822_PHYSCR_INTEN;
244
245 } else {
246 err = phy_write(phydev, MII_DP83822_MISR1, 0);
247 if (err < 0)
248 return err;
249
250 err = phy_write(phydev, MII_DP83822_MISR1, 0);
251 if (err < 0)
252 return err;
253
254 physcr_status = phy_read(phydev, MII_DP83822_PHYSCR);
255 if (physcr_status < 0)
256 return physcr_status;
257
258 physcr_status &= ~DP83822_PHYSCR_INTEN;
259 }
260
261 return phy_write(phydev, MII_DP83822_PHYSCR, physcr_status);
262}
263
264static int dp8382x_disable_wol(struct phy_device *phydev)
265{
266 int value = DP83822_WOL_EN | DP83822_WOL_MAGIC_EN |
267 DP83822_WOL_SECURE_ON;
268
269 return phy_clear_bits_mmd(phydev, DP83822_DEVADDR,
270 MII_DP83822_WOL_CFG, value);
271}
272
273static int dp83822_config_init(struct phy_device *phydev)
274{
275 struct device *dev = &phydev->mdio.dev;
276 int rgmii_delay;
277 s32 rx_int_delay;
278 s32 tx_int_delay;
279 int err = 0;
280
281 if (phy_interface_is_rgmii(phydev)) {
282 rx_int_delay = phy_get_internal_delay(phydev, dev, NULL, 0,
283 true);
284
285 if (rx_int_delay <= 0)
286 rgmii_delay = 0;
287 else
288 rgmii_delay = DP83822_RX_CLK_SHIFT;
289
290 tx_int_delay = phy_get_internal_delay(phydev, dev, NULL, 0,
291 false);
292 if (tx_int_delay <= 0)
293 rgmii_delay &= ~DP83822_TX_CLK_SHIFT;
294 else
295 rgmii_delay |= DP83822_TX_CLK_SHIFT;
296
297 if (rgmii_delay) {
298 err = phy_set_bits_mmd(phydev, DP83822_DEVADDR,
299 MII_DP83822_RCSR, rgmii_delay);
300 if (err)
301 return err;
302 }
303 }
304
305 return dp8382x_disable_wol(phydev);
306}
307
308static int dp8382x_config_init(struct phy_device *phydev)
309{
310 return dp8382x_disable_wol(phydev);
311}
312
313static int dp83822_phy_reset(struct phy_device *phydev)
314{
315 int err;
316
317 err = phy_write(phydev, MII_DP83822_RESET_CTRL, DP83822_HW_RESET);
318 if (err < 0)
319 return err;
320
321 return phydev->drv->config_init(phydev);
322}
323
324static int dp83822_suspend(struct phy_device *phydev)
325{
326 int value;
327
328 value = phy_read_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG);
329
330 if (!(value & DP83822_WOL_EN))
331 genphy_suspend(phydev);
332
333 return 0;
334}
335
336static int dp83822_resume(struct phy_device *phydev)
337{
338 int value;
339
340 genphy_resume(phydev);
341
342 value = phy_read_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG);
343
344 phy_write_mmd(phydev, DP83822_DEVADDR, MII_DP83822_WOL_CFG, value |
345 DP83822_WOL_CLR_INDICATION);
346
347 return 0;
348}
349
350#define DP83822_PHY_DRIVER(_id, _name) \
351 { \
352 PHY_ID_MATCH_MODEL(_id), \
353 .name = (_name), \
354 /* PHY_BASIC_FEATURES */ \
355 .soft_reset = dp83822_phy_reset, \
356 .config_init = dp83822_config_init, \
357 .get_wol = dp83822_get_wol, \
358 .set_wol = dp83822_set_wol, \
359 .ack_interrupt = dp83822_ack_interrupt, \
360 .config_intr = dp83822_config_intr, \
361 .suspend = dp83822_suspend, \
362 .resume = dp83822_resume, \
363 }
364
365#define DP8382X_PHY_DRIVER(_id, _name) \
366 { \
367 PHY_ID_MATCH_MODEL(_id), \
368 .name = (_name), \
369 /* PHY_BASIC_FEATURES */ \
370 .soft_reset = dp83822_phy_reset, \
371 .config_init = dp8382x_config_init, \
372 .get_wol = dp83822_get_wol, \
373 .set_wol = dp83822_set_wol, \
374 .ack_interrupt = dp83822_ack_interrupt, \
375 .config_intr = dp83822_config_intr, \
376 .suspend = dp83822_suspend, \
377 .resume = dp83822_resume, \
378 }
379
380static struct phy_driver dp83822_driver[] = {
381 DP83822_PHY_DRIVER(DP83822_PHY_ID, "TI DP83822"),
382 DP8382X_PHY_DRIVER(DP83825I_PHY_ID, "TI DP83825I"),
383 DP8382X_PHY_DRIVER(DP83826C_PHY_ID, "TI DP83826C"),
384 DP8382X_PHY_DRIVER(DP83826NC_PHY_ID, "TI DP83826NC"),
385 DP8382X_PHY_DRIVER(DP83825S_PHY_ID, "TI DP83825S"),
386 DP8382X_PHY_DRIVER(DP83825CM_PHY_ID, "TI DP83825M"),
387 DP8382X_PHY_DRIVER(DP83825CS_PHY_ID, "TI DP83825CS"),
388};
389module_phy_driver(dp83822_driver);
390
391static struct mdio_device_id __maybe_unused dp83822_tbl[] = {
392 { DP83822_PHY_ID, 0xfffffff0 },
393 { DP83825I_PHY_ID, 0xfffffff0 },
394 { DP83826C_PHY_ID, 0xfffffff0 },
395 { DP83826NC_PHY_ID, 0xfffffff0 },
396 { DP83825S_PHY_ID, 0xfffffff0 },
397 { DP83825CM_PHY_ID, 0xfffffff0 },
398 { DP83825CS_PHY_ID, 0xfffffff0 },
399 { },
400};
401MODULE_DEVICE_TABLE(mdio, dp83822_tbl);
402
403MODULE_DESCRIPTION("Texas Instruments DP83822 PHY driver");
404MODULE_AUTHOR("Dan Murphy <dmurphy@ti.com");
405MODULE_LICENSE("GPL v2");