This source file includes following definitions.
- __afu_port_err_mask
- afu_port_err_mask
- afu_port_err_clear
- errors_show
- errors_store
- first_error_show
- first_malformed_req_show
- port_err_attrs_visible
- port_err_init
- port_err_uinit
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17 #include <linux/uaccess.h>
18
19 #include "dfl-afu.h"
20
21 #define PORT_ERROR_MASK 0x8
22 #define PORT_ERROR 0x10
23 #define PORT_FIRST_ERROR 0x18
24 #define PORT_MALFORMED_REQ0 0x20
25 #define PORT_MALFORMED_REQ1 0x28
26
27 #define ERROR_MASK GENMASK_ULL(63, 0)
28
29
30 static void __afu_port_err_mask(struct device *dev, bool mask)
31 {
32 void __iomem *base;
33
34 base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_ERROR);
35
36 writeq(mask ? ERROR_MASK : 0, base + PORT_ERROR_MASK);
37 }
38
39 static void afu_port_err_mask(struct device *dev, bool mask)
40 {
41 struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
42
43 mutex_lock(&pdata->lock);
44 __afu_port_err_mask(dev, mask);
45 mutex_unlock(&pdata->lock);
46 }
47
48
49 static int afu_port_err_clear(struct device *dev, u64 err)
50 {
51 struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
52 struct platform_device *pdev = to_platform_device(dev);
53 void __iomem *base_err, *base_hdr;
54 int ret = -EBUSY;
55 u64 v;
56
57 base_err = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_ERROR);
58 base_hdr = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_HEADER);
59
60 mutex_lock(&pdata->lock);
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75 v = readq(base_hdr + PORT_HDR_STS);
76 if (FIELD_GET(PORT_STS_PWR_STATE, v) == PORT_STS_PWR_STATE_AP6) {
77 dev_err(dev, "Could not clear errors, device in AP6 state.\n");
78 goto done;
79 }
80
81
82 ret = __afu_port_disable(pdev);
83 if (ret)
84 goto done;
85
86
87 __afu_port_err_mask(dev, true);
88
89
90 v = readq(base_err + PORT_ERROR);
91
92 if (v == err) {
93 writeq(v, base_err + PORT_ERROR);
94
95 v = readq(base_err + PORT_FIRST_ERROR);
96 writeq(v, base_err + PORT_FIRST_ERROR);
97 } else {
98 ret = -EINVAL;
99 }
100
101
102 __afu_port_err_mask(dev, false);
103
104
105 __afu_port_enable(pdev);
106
107 done:
108 mutex_unlock(&pdata->lock);
109 return ret;
110 }
111
112 static ssize_t errors_show(struct device *dev, struct device_attribute *attr,
113 char *buf)
114 {
115 struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
116 void __iomem *base;
117 u64 error;
118
119 base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_ERROR);
120
121 mutex_lock(&pdata->lock);
122 error = readq(base + PORT_ERROR);
123 mutex_unlock(&pdata->lock);
124
125 return sprintf(buf, "0x%llx\n", (unsigned long long)error);
126 }
127
128 static ssize_t errors_store(struct device *dev, struct device_attribute *attr,
129 const char *buff, size_t count)
130 {
131 u64 value;
132 int ret;
133
134 if (kstrtou64(buff, 0, &value))
135 return -EINVAL;
136
137 ret = afu_port_err_clear(dev, value);
138
139 return ret ? ret : count;
140 }
141 static DEVICE_ATTR_RW(errors);
142
143 static ssize_t first_error_show(struct device *dev,
144 struct device_attribute *attr, char *buf)
145 {
146 struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
147 void __iomem *base;
148 u64 error;
149
150 base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_ERROR);
151
152 mutex_lock(&pdata->lock);
153 error = readq(base + PORT_FIRST_ERROR);
154 mutex_unlock(&pdata->lock);
155
156 return sprintf(buf, "0x%llx\n", (unsigned long long)error);
157 }
158 static DEVICE_ATTR_RO(first_error);
159
160 static ssize_t first_malformed_req_show(struct device *dev,
161 struct device_attribute *attr,
162 char *buf)
163 {
164 struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
165 void __iomem *base;
166 u64 req0, req1;
167
168 base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_ERROR);
169
170 mutex_lock(&pdata->lock);
171 req0 = readq(base + PORT_MALFORMED_REQ0);
172 req1 = readq(base + PORT_MALFORMED_REQ1);
173 mutex_unlock(&pdata->lock);
174
175 return sprintf(buf, "0x%016llx%016llx\n",
176 (unsigned long long)req1, (unsigned long long)req0);
177 }
178 static DEVICE_ATTR_RO(first_malformed_req);
179
180 static struct attribute *port_err_attrs[] = {
181 &dev_attr_errors.attr,
182 &dev_attr_first_error.attr,
183 &dev_attr_first_malformed_req.attr,
184 NULL,
185 };
186
187 static umode_t port_err_attrs_visible(struct kobject *kobj,
188 struct attribute *attr, int n)
189 {
190 struct device *dev = kobj_to_dev(kobj);
191
192
193
194
195
196 if (!dfl_get_feature_by_id(dev, PORT_FEATURE_ID_ERROR))
197 return 0;
198
199 return attr->mode;
200 }
201
202 const struct attribute_group port_err_group = {
203 .name = "errors",
204 .attrs = port_err_attrs,
205 .is_visible = port_err_attrs_visible,
206 };
207
208 static int port_err_init(struct platform_device *pdev,
209 struct dfl_feature *feature)
210 {
211 afu_port_err_mask(&pdev->dev, false);
212
213 return 0;
214 }
215
216 static void port_err_uinit(struct platform_device *pdev,
217 struct dfl_feature *feature)
218 {
219 afu_port_err_mask(&pdev->dev, true);
220 }
221
222 const struct dfl_feature_id port_err_id_table[] = {
223 {.id = PORT_FEATURE_ID_ERROR,},
224 {0,}
225 };
226
227 const struct dfl_feature_ops port_err_ops = {
228 .init = port_err_init,
229 .uinit = port_err_uinit,
230 };