1
2
3
4
5
6
7#include <linux/bitfield.h>
8#include <linux/bits.h>
9#include <linux/mdio.h>
10#include <linux/module.h>
11#include <linux/phy.h>
12#include <linux/if_vlan.h>
13#include <linux/of.h>
14#include "xrs700x.h"
15#include "xrs700x_reg.h"
16
17#define XRS_MDIO_IBA0 0x10
18#define XRS_MDIO_IBA1 0x11
19#define XRS_MDIO_IBD 0x14
20
21#define XRS_IB_READ 0x0
22#define XRS_IB_WRITE 0x1
23
24static int xrs700x_mdio_reg_read(void *context, unsigned int reg,
25 unsigned int *val)
26{
27 struct mdio_device *mdiodev = context;
28 struct device *dev = &mdiodev->dev;
29 u16 uval;
30 int ret;
31
32 uval = (u16)FIELD_GET(GENMASK(31, 16), reg);
33
34 ret = mdiobus_write(mdiodev->bus, mdiodev->addr, XRS_MDIO_IBA1, uval);
35 if (ret < 0) {
36 dev_err(dev, "xrs mdiobus_write returned %d\n", ret);
37 return ret;
38 }
39
40 uval = (u16)((reg & GENMASK(15, 1)) | XRS_IB_READ);
41
42 ret = mdiobus_write(mdiodev->bus, mdiodev->addr, XRS_MDIO_IBA0, uval);
43 if (ret < 0) {
44 dev_err(dev, "xrs mdiobus_write returned %d\n", ret);
45 return ret;
46 }
47
48 ret = mdiobus_read(mdiodev->bus, mdiodev->addr, XRS_MDIO_IBD);
49 if (ret < 0) {
50 dev_err(dev, "xrs mdiobus_read returned %d\n", ret);
51 return ret;
52 }
53
54 *val = (unsigned int)ret;
55
56 return 0;
57}
58
59static int xrs700x_mdio_reg_write(void *context, unsigned int reg,
60 unsigned int val)
61{
62 struct mdio_device *mdiodev = context;
63 struct device *dev = &mdiodev->dev;
64 u16 uval;
65 int ret;
66
67 ret = mdiobus_write(mdiodev->bus, mdiodev->addr, XRS_MDIO_IBD, (u16)val);
68 if (ret < 0) {
69 dev_err(dev, "xrs mdiobus_write returned %d\n", ret);
70 return ret;
71 }
72
73 uval = (u16)FIELD_GET(GENMASK(31, 16), reg);
74
75 ret = mdiobus_write(mdiodev->bus, mdiodev->addr, XRS_MDIO_IBA1, uval);
76 if (ret < 0) {
77 dev_err(dev, "xrs mdiobus_write returned %d\n", ret);
78 return ret;
79 }
80
81 uval = (u16)((reg & GENMASK(15, 1)) | XRS_IB_WRITE);
82
83 ret = mdiobus_write(mdiodev->bus, mdiodev->addr, XRS_MDIO_IBA0, uval);
84 if (ret < 0) {
85 dev_err(dev, "xrs mdiobus_write returned %d\n", ret);
86 return ret;
87 }
88
89 return 0;
90}
91
92static const struct regmap_config xrs700x_mdio_regmap_config = {
93 .val_bits = 16,
94 .reg_stride = 2,
95 .reg_bits = 32,
96 .pad_bits = 0,
97 .write_flag_mask = 0,
98 .read_flag_mask = 0,
99 .reg_read = xrs700x_mdio_reg_read,
100 .reg_write = xrs700x_mdio_reg_write,
101 .max_register = XRS_VLAN(VLAN_N_VID - 1),
102 .cache_type = REGCACHE_NONE,
103 .reg_format_endian = REGMAP_ENDIAN_BIG,
104 .val_format_endian = REGMAP_ENDIAN_BIG
105};
106
107static int xrs700x_mdio_probe(struct mdio_device *mdiodev)
108{
109 struct xrs700x *priv;
110 int ret;
111
112 priv = xrs700x_switch_alloc(&mdiodev->dev, mdiodev);
113 if (!priv)
114 return -ENOMEM;
115
116 priv->regmap = devm_regmap_init(&mdiodev->dev, NULL, mdiodev,
117 &xrs700x_mdio_regmap_config);
118 if (IS_ERR(priv->regmap)) {
119 ret = PTR_ERR(priv->regmap);
120 dev_err(&mdiodev->dev, "Failed to initialize regmap: %d\n", ret);
121 return ret;
122 }
123
124 dev_set_drvdata(&mdiodev->dev, priv);
125
126 ret = xrs700x_switch_register(priv);
127
128
129 if (ret)
130 return ret;
131
132 return 0;
133}
134
135static void xrs700x_mdio_remove(struct mdio_device *mdiodev)
136{
137 struct xrs700x *priv = dev_get_drvdata(&mdiodev->dev);
138
139 if (!priv)
140 return;
141
142 xrs700x_switch_remove(priv);
143
144 dev_set_drvdata(&mdiodev->dev, NULL);
145}
146
147static void xrs700x_mdio_shutdown(struct mdio_device *mdiodev)
148{
149 struct xrs700x *priv = dev_get_drvdata(&mdiodev->dev);
150
151 if (!priv)
152 return;
153
154 xrs700x_switch_shutdown(priv);
155
156 dev_set_drvdata(&mdiodev->dev, NULL);
157}
158
159static const struct of_device_id __maybe_unused xrs700x_mdio_dt_ids[] = {
160 { .compatible = "arrow,xrs7003e", .data = &xrs7003e_info },
161 { .compatible = "arrow,xrs7003f", .data = &xrs7003f_info },
162 { .compatible = "arrow,xrs7004e", .data = &xrs7004e_info },
163 { .compatible = "arrow,xrs7004f", .data = &xrs7004f_info },
164 {},
165};
166MODULE_DEVICE_TABLE(of, xrs700x_mdio_dt_ids);
167
168static struct mdio_driver xrs700x_mdio_driver = {
169 .mdiodrv.driver = {
170 .name = "xrs700x-mdio",
171 .of_match_table = of_match_ptr(xrs700x_mdio_dt_ids),
172 },
173 .probe = xrs700x_mdio_probe,
174 .remove = xrs700x_mdio_remove,
175 .shutdown = xrs700x_mdio_shutdown,
176};
177
178mdio_module_driver(xrs700x_mdio_driver);
179
180MODULE_AUTHOR("George McCollister <george.mccollister@gmail.com>");
181MODULE_DESCRIPTION("Arrow SpeedChips XRS700x DSA MDIO driver");
182MODULE_LICENSE("GPL v2");
183
