Blame view

drivers/fpga/dfl-afu-main.c 22.9 KB
1a1527cf5   Wu Hao   fpga: dfl: add FP...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
  // SPDX-License-Identifier: GPL-2.0
  /*
   * Driver for FPGA Accelerated Function Unit (AFU)
   *
   * Copyright (C) 2017-2018 Intel Corporation, Inc.
   *
   * Authors:
   *   Wu Hao <hao.wu@intel.com>
   *   Xiao Guangrong <guangrong.xiao@linux.intel.com>
   *   Joseph Grecco <joe.grecco@intel.com>
   *   Enno Luebbers <enno.luebbers@intel.com>
   *   Tim Whisonant <tim.whisonant@intel.com>
   *   Ananda Ravuri <ananda.ravuri@intel.com>
   *   Henry Mitchel <henry.mitchel@intel.com>
   */
  
  #include <linux/kernel.h>
  #include <linux/module.h>
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
19
  #include <linux/uaccess.h>
e4664c0ee   Wu Hao   fpga: dfl: afu: a...
20
  #include <linux/fpga-dfl.h>
1a1527cf5   Wu Hao   fpga: dfl: add FP...
21

857a26222   Xiao Guangrong   fpga: dfl: afu: a...
22
  #include "dfl-afu.h"
1a1527cf5   Wu Hao   fpga: dfl: add FP...
23

47c1b19c1   Wu Hao   fpga: dfl: afu: a...
24
  /**
95844372f   Wu Hao   fpga: dfl: afu: e...
25
   * __afu_port_enable - enable a port by clear reset
47c1b19c1   Wu Hao   fpga: dfl: afu: a...
26
27
28
   * @pdev: port platform device.
   *
   * Enable Port by clear the port soft reset bit, which is set by default.
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
29
   * The AFU is unable to respond to any MMIO access while in reset.
95844372f   Wu Hao   fpga: dfl: afu: e...
30
31
32
33
   * __afu_port_enable function should only be used after __afu_port_disable
   * function.
   *
   * The caller needs to hold lock for protection.
47c1b19c1   Wu Hao   fpga: dfl: afu: a...
34
   */
95844372f   Wu Hao   fpga: dfl: afu: e...
35
  void __afu_port_enable(struct platform_device *pdev)
47c1b19c1   Wu Hao   fpga: dfl: afu: a...
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(&pdev->dev);
  	void __iomem *base;
  	u64 v;
  
  	WARN_ON(!pdata->disable_count);
  
  	if (--pdata->disable_count != 0)
  		return;
  
  	base = dfl_get_feature_ioaddr_by_id(&pdev->dev, PORT_FEATURE_ID_HEADER);
  
  	/* Clear port soft reset */
  	v = readq(base + PORT_HDR_CTRL);
  	v &= ~PORT_CTRL_SFTRST;
  	writeq(v, base + PORT_HDR_CTRL);
  }
  
  #define RST_POLL_INVL 10 /* us */
  #define RST_POLL_TIMEOUT 1000 /* us */
  
  /**
95844372f   Wu Hao   fpga: dfl: afu: e...
58
   * __afu_port_disable - disable a port by hold reset
47c1b19c1   Wu Hao   fpga: dfl: afu: a...
59
60
   * @pdev: port platform device.
   *
95844372f   Wu Hao   fpga: dfl: afu: e...
61
62
63
   * Disable Port by setting the port soft reset bit, it puts the port into reset.
   *
   * The caller needs to hold lock for protection.
47c1b19c1   Wu Hao   fpga: dfl: afu: a...
64
   */
95844372f   Wu Hao   fpga: dfl: afu: e...
65
  int __afu_port_disable(struct platform_device *pdev)
47c1b19c1   Wu Hao   fpga: dfl: afu: a...
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(&pdev->dev);
  	void __iomem *base;
  	u64 v;
  
  	if (pdata->disable_count++ != 0)
  		return 0;
  
  	base = dfl_get_feature_ioaddr_by_id(&pdev->dev, PORT_FEATURE_ID_HEADER);
  
  	/* Set port soft reset */
  	v = readq(base + PORT_HDR_CTRL);
  	v |= PORT_CTRL_SFTRST;
  	writeq(v, base + PORT_HDR_CTRL);
  
  	/*
  	 * HW sets ack bit to 1 when all outstanding requests have been drained
  	 * on this port and minimum soft reset pulse width has elapsed.
  	 * Driver polls port_soft_reset_ack to determine if reset done by HW.
  	 */
8614afd68   Matthew Gerlach   fpga: dfl: fix bu...
86
87
  	if (readq_poll_timeout(base + PORT_HDR_CTRL, v,
  			       v & PORT_CTRL_SFTRST_ACK,
47c1b19c1   Wu Hao   fpga: dfl: afu: a...
88
89
90
91
92
93
94
95
  			       RST_POLL_INVL, RST_POLL_TIMEOUT)) {
  		dev_err(&pdev->dev, "timeout, fail to reset device
  ");
  		return -ETIMEDOUT;
  	}
  
  	return 0;
  }
e4664c0ee   Wu Hao   fpga: dfl: afu: a...
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
  /*
   * This function resets the FPGA Port and its accelerator (AFU) by function
   * __port_disable and __port_enable (set port soft reset bit and then clear
   * it). Userspace can do Port reset at any time, e.g. during DMA or Partial
   * Reconfiguration. But it should never cause any system level issue, only
   * functional failure (e.g. DMA or PR operation failure) and be recoverable
   * from the failure.
   *
   * Note: the accelerator (AFU) is not accessible when its port is in reset
   * (disabled). Any attempts on MMIO access to AFU while in reset, will
   * result errors reported via port error reporting sub feature (if present).
   */
  static int __port_reset(struct platform_device *pdev)
  {
  	int ret;
95844372f   Wu Hao   fpga: dfl: afu: e...
111
  	ret = __afu_port_disable(pdev);
e4664c0ee   Wu Hao   fpga: dfl: afu: a...
112
  	if (!ret)
95844372f   Wu Hao   fpga: dfl: afu: e...
113
  		__afu_port_enable(pdev);
e4664c0ee   Wu Hao   fpga: dfl: afu: a...
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
  
  	return ret;
  }
  
  static int port_reset(struct platform_device *pdev)
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(&pdev->dev);
  	int ret;
  
  	mutex_lock(&pdata->lock);
  	ret = __port_reset(pdev);
  	mutex_unlock(&pdata->lock);
  
  	return ret;
  }
47c1b19c1   Wu Hao   fpga: dfl: afu: a...
129
130
131
132
133
134
135
136
  static int port_get_id(struct platform_device *pdev)
  {
  	void __iomem *base;
  
  	base = dfl_get_feature_ioaddr_by_id(&pdev->dev, PORT_FEATURE_ID_HEADER);
  
  	return FIELD_GET(PORT_CAP_PORT_NUM, readq(base + PORT_HDR_CAP));
  }
e4664c0ee   Wu Hao   fpga: dfl: afu: a...
137
138
139
140
141
142
143
144
145
  static ssize_t
  id_show(struct device *dev, struct device_attribute *attr, char *buf)
  {
  	int id = port_get_id(to_platform_device(dev));
  
  	return scnprintf(buf, PAGE_SIZE, "%d
  ", id);
  }
  static DEVICE_ATTR_RO(id);
d2ad5ac1c   Wu Hao   fpga: dfl: afu: a...
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
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
  static ssize_t
  ltr_show(struct device *dev, struct device_attribute *attr, char *buf)
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
  	void __iomem *base;
  	u64 v;
  
  	base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_HEADER);
  
  	mutex_lock(&pdata->lock);
  	v = readq(base + PORT_HDR_CTRL);
  	mutex_unlock(&pdata->lock);
  
  	return sprintf(buf, "%x
  ", (u8)FIELD_GET(PORT_CTRL_LATENCY, v));
  }
  
  static ssize_t
  ltr_store(struct device *dev, struct device_attribute *attr,
  	  const char *buf, size_t count)
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
  	void __iomem *base;
  	bool ltr;
  	u64 v;
  
  	if (kstrtobool(buf, &ltr))
  		return -EINVAL;
  
  	base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_HEADER);
  
  	mutex_lock(&pdata->lock);
  	v = readq(base + PORT_HDR_CTRL);
  	v &= ~PORT_CTRL_LATENCY;
  	v |= FIELD_PREP(PORT_CTRL_LATENCY, ltr ? 1 : 0);
  	writeq(v, base + PORT_HDR_CTRL);
  	mutex_unlock(&pdata->lock);
  
  	return count;
  }
  static DEVICE_ATTR_RW(ltr);
  
  static ssize_t
  ap1_event_show(struct device *dev, struct device_attribute *attr, char *buf)
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
  	void __iomem *base;
  	u64 v;
  
  	base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_HEADER);
  
  	mutex_lock(&pdata->lock);
  	v = readq(base + PORT_HDR_STS);
  	mutex_unlock(&pdata->lock);
  
  	return sprintf(buf, "%x
  ", (u8)FIELD_GET(PORT_STS_AP1_EVT, v));
  }
  
  static ssize_t
  ap1_event_store(struct device *dev, struct device_attribute *attr,
  		const char *buf, size_t count)
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
  	void __iomem *base;
  	bool clear;
  
  	if (kstrtobool(buf, &clear) || !clear)
  		return -EINVAL;
  
  	base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_HEADER);
  
  	mutex_lock(&pdata->lock);
  	writeq(PORT_STS_AP1_EVT, base + PORT_HDR_STS);
  	mutex_unlock(&pdata->lock);
  
  	return count;
  }
  static DEVICE_ATTR_RW(ap1_event);
  
  static ssize_t
  ap2_event_show(struct device *dev, struct device_attribute *attr,
  	       char *buf)
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
  	void __iomem *base;
  	u64 v;
  
  	base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_HEADER);
  
  	mutex_lock(&pdata->lock);
  	v = readq(base + PORT_HDR_STS);
  	mutex_unlock(&pdata->lock);
  
  	return sprintf(buf, "%x
  ", (u8)FIELD_GET(PORT_STS_AP2_EVT, v));
  }
  
  static ssize_t
  ap2_event_store(struct device *dev, struct device_attribute *attr,
  		const char *buf, size_t count)
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
  	void __iomem *base;
  	bool clear;
  
  	if (kstrtobool(buf, &clear) || !clear)
  		return -EINVAL;
  
  	base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_HEADER);
  
  	mutex_lock(&pdata->lock);
  	writeq(PORT_STS_AP2_EVT, base + PORT_HDR_STS);
  	mutex_unlock(&pdata->lock);
  
  	return count;
  }
  static DEVICE_ATTR_RW(ap2_event);
  
  static ssize_t
  power_state_show(struct device *dev, struct device_attribute *attr, char *buf)
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
  	void __iomem *base;
  	u64 v;
  
  	base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_HEADER);
  
  	mutex_lock(&pdata->lock);
  	v = readq(base + PORT_HDR_STS);
  	mutex_unlock(&pdata->lock);
  
  	return sprintf(buf, "0x%x
  ", (u8)FIELD_GET(PORT_STS_PWR_STATE, v));
  }
  static DEVICE_ATTR_RO(power_state);
f09991adf   Wu Hao   fpga: dfl: afu: a...
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
  static ssize_t
  userclk_freqcmd_store(struct device *dev, struct device_attribute *attr,
  		      const char *buf, size_t count)
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
  	u64 userclk_freq_cmd;
  	void __iomem *base;
  
  	if (kstrtou64(buf, 0, &userclk_freq_cmd))
  		return -EINVAL;
  
  	base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_HEADER);
  
  	mutex_lock(&pdata->lock);
  	writeq(userclk_freq_cmd, base + PORT_HDR_USRCLK_CMD0);
  	mutex_unlock(&pdata->lock);
  
  	return count;
  }
  static DEVICE_ATTR_WO(userclk_freqcmd);
  
  static ssize_t
  userclk_freqcntrcmd_store(struct device *dev, struct device_attribute *attr,
  			  const char *buf, size_t count)
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
  	u64 userclk_freqcntr_cmd;
  	void __iomem *base;
  
  	if (kstrtou64(buf, 0, &userclk_freqcntr_cmd))
  		return -EINVAL;
  
  	base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_HEADER);
  
  	mutex_lock(&pdata->lock);
  	writeq(userclk_freqcntr_cmd, base + PORT_HDR_USRCLK_CMD1);
  	mutex_unlock(&pdata->lock);
  
  	return count;
  }
  static DEVICE_ATTR_WO(userclk_freqcntrcmd);
  
  static ssize_t
  userclk_freqsts_show(struct device *dev, struct device_attribute *attr,
  		     char *buf)
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
  	u64 userclk_freqsts;
  	void __iomem *base;
  
  	base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_HEADER);
  
  	mutex_lock(&pdata->lock);
  	userclk_freqsts = readq(base + PORT_HDR_USRCLK_STS0);
  	mutex_unlock(&pdata->lock);
  
  	return sprintf(buf, "0x%llx
  ", (unsigned long long)userclk_freqsts);
  }
  static DEVICE_ATTR_RO(userclk_freqsts);
  
  static ssize_t
  userclk_freqcntrsts_show(struct device *dev, struct device_attribute *attr,
  			 char *buf)
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
  	u64 userclk_freqcntrsts;
  	void __iomem *base;
  
  	base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_HEADER);
  
  	mutex_lock(&pdata->lock);
  	userclk_freqcntrsts = readq(base + PORT_HDR_USRCLK_STS1);
  	mutex_unlock(&pdata->lock);
  
  	return sprintf(buf, "0x%llx
  ",
  		       (unsigned long long)userclk_freqcntrsts);
  }
  static DEVICE_ATTR_RO(userclk_freqcntrsts);
dcfecd4d7   Greg Kroah-Hartman   fpga: dfl: use dr...
362
  static struct attribute *port_hdr_attrs[] = {
e4664c0ee   Wu Hao   fpga: dfl: afu: a...
363
  	&dev_attr_id.attr,
d2ad5ac1c   Wu Hao   fpga: dfl: afu: a...
364
365
366
367
  	&dev_attr_ltr.attr,
  	&dev_attr_ap1_event.attr,
  	&dev_attr_ap2_event.attr,
  	&dev_attr_power_state.attr,
f09991adf   Wu Hao   fpga: dfl: afu: a...
368
369
370
371
  	&dev_attr_userclk_freqcmd.attr,
  	&dev_attr_userclk_freqcntrcmd.attr,
  	&dev_attr_userclk_freqsts.attr,
  	&dev_attr_userclk_freqcntrsts.attr,
e4664c0ee   Wu Hao   fpga: dfl: afu: a...
372
373
  	NULL,
  };
a80a4b82e   Wu Hao   fpga: dfl: afu: c...
374

f09991adf   Wu Hao   fpga: dfl: afu: a...
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
  static umode_t port_hdr_attrs_visible(struct kobject *kobj,
  				      struct attribute *attr, int n)
  {
  	struct device *dev = kobj_to_dev(kobj);
  	umode_t mode = attr->mode;
  	void __iomem *base;
  
  	base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_HEADER);
  
  	if (dfl_feature_revision(base) > 0) {
  		/*
  		 * userclk sysfs interfaces are only visible in case port
  		 * revision is 0, as hardware with revision >0 doesn't
  		 * support this.
  		 */
  		if (attr == &dev_attr_userclk_freqcmd.attr ||
  		    attr == &dev_attr_userclk_freqcntrcmd.attr ||
  		    attr == &dev_attr_userclk_freqsts.attr ||
  		    attr == &dev_attr_userclk_freqcntrsts.attr)
  			mode = 0;
  	}
  
  	return mode;
  }
a80a4b82e   Wu Hao   fpga: dfl: afu: c...
399
  static const struct attribute_group port_hdr_group = {
f09991adf   Wu Hao   fpga: dfl: afu: a...
400
401
  	.attrs      = port_hdr_attrs,
  	.is_visible = port_hdr_attrs_visible,
a80a4b82e   Wu Hao   fpga: dfl: afu: c...
402
  };
e4664c0ee   Wu Hao   fpga: dfl: afu: a...
403

1a1527cf5   Wu Hao   fpga: dfl: add FP...
404
405
406
  static int port_hdr_init(struct platform_device *pdev,
  			 struct dfl_feature *feature)
  {
e4664c0ee   Wu Hao   fpga: dfl: afu: a...
407
  	port_reset(pdev);
a80a4b82e   Wu Hao   fpga: dfl: afu: c...
408
  	return 0;
e4664c0ee   Wu Hao   fpga: dfl: afu: a...
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
  }
  
  static long
  port_hdr_ioctl(struct platform_device *pdev, struct dfl_feature *feature,
  	       unsigned int cmd, unsigned long arg)
  {
  	long ret;
  
  	switch (cmd) {
  	case DFL_FPGA_PORT_RESET:
  		if (!arg)
  			ret = port_reset(pdev);
  		else
  			ret = -EINVAL;
  		break;
  	default:
  		dev_dbg(&pdev->dev, "%x cmd not handled", cmd);
  		ret = -ENODEV;
  	}
  
  	return ret;
1a1527cf5   Wu Hao   fpga: dfl: add FP...
430
  }
15bbb300f   Wu Hao   fpga: dfl: add id...
431
432
433
434
  static const struct dfl_feature_id port_hdr_id_table[] = {
  	{.id = PORT_FEATURE_ID_HEADER,},
  	{0,}
  };
1a1527cf5   Wu Hao   fpga: dfl: add FP...
435
436
  static const struct dfl_feature_ops port_hdr_ops = {
  	.init = port_hdr_init,
e4664c0ee   Wu Hao   fpga: dfl: afu: a...
437
  	.ioctl = port_hdr_ioctl,
1a1527cf5   Wu Hao   fpga: dfl: add FP...
438
  };
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
  static ssize_t
  afu_id_show(struct device *dev, struct device_attribute *attr, char *buf)
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(dev);
  	void __iomem *base;
  	u64 guidl, guidh;
  
  	base = dfl_get_feature_ioaddr_by_id(dev, PORT_FEATURE_ID_AFU);
  
  	mutex_lock(&pdata->lock);
  	if (pdata->disable_count) {
  		mutex_unlock(&pdata->lock);
  		return -EBUSY;
  	}
  
  	guidl = readq(base + GUID_L);
  	guidh = readq(base + GUID_H);
  	mutex_unlock(&pdata->lock);
  
  	return scnprintf(buf, PAGE_SIZE, "%016llx%016llx
  ", guidh, guidl);
  }
  static DEVICE_ATTR_RO(afu_id);
dcfecd4d7   Greg Kroah-Hartman   fpga: dfl: use dr...
462
  static struct attribute *port_afu_attrs[] = {
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
463
464
465
  	&dev_attr_afu_id.attr,
  	NULL
  };
a80a4b82e   Wu Hao   fpga: dfl: afu: c...
466
467
  static umode_t port_afu_attrs_visible(struct kobject *kobj,
  				      struct attribute *attr, int n)
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
468
  {
a80a4b82e   Wu Hao   fpga: dfl: afu: c...
469
  	struct device *dev = kobj_to_dev(kobj);
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
470

a80a4b82e   Wu Hao   fpga: dfl: afu: c...
471
472
473
474
475
476
  	/*
  	 * sysfs entries are visible only if related private feature is
  	 * enumerated.
  	 */
  	if (!dfl_get_feature_by_id(dev, PORT_FEATURE_ID_AFU))
  		return 0;
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
477

a80a4b82e   Wu Hao   fpga: dfl: afu: c...
478
  	return attr->mode;
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
479
  }
a80a4b82e   Wu Hao   fpga: dfl: afu: c...
480
481
482
483
484
485
486
  static const struct attribute_group port_afu_group = {
  	.attrs      = port_afu_attrs,
  	.is_visible = port_afu_attrs_visible,
  };
  
  static int port_afu_init(struct platform_device *pdev,
  			 struct dfl_feature *feature)
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
487
  {
a80a4b82e   Wu Hao   fpga: dfl: afu: c...
488
  	struct resource *res = &pdev->resource[feature->resource_index];
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
489

a80a4b82e   Wu Hao   fpga: dfl: afu: c...
490
491
492
493
494
  	return afu_mmio_region_add(dev_get_platdata(&pdev->dev),
  				   DFL_PORT_REGION_INDEX_AFU,
  				   resource_size(res), res->start,
  				   DFL_PORT_REGION_MMAP | DFL_PORT_REGION_READ |
  				   DFL_PORT_REGION_WRITE);
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
495
  }
15bbb300f   Wu Hao   fpga: dfl: add id...
496
497
498
499
  static const struct dfl_feature_id port_afu_id_table[] = {
  	{.id = PORT_FEATURE_ID_AFU,},
  	{0,}
  };
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
500
501
  static const struct dfl_feature_ops port_afu_ops = {
  	.init = port_afu_init,
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
502
  };
bd127b819   Wu Hao   fpga: dfl: afu: a...
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
  static int port_stp_init(struct platform_device *pdev,
  			 struct dfl_feature *feature)
  {
  	struct resource *res = &pdev->resource[feature->resource_index];
  
  	return afu_mmio_region_add(dev_get_platdata(&pdev->dev),
  				   DFL_PORT_REGION_INDEX_STP,
  				   resource_size(res), res->start,
  				   DFL_PORT_REGION_MMAP | DFL_PORT_REGION_READ |
  				   DFL_PORT_REGION_WRITE);
  }
  
  static const struct dfl_feature_id port_stp_id_table[] = {
  	{.id = PORT_FEATURE_ID_STP,},
  	{0,}
  };
  
  static const struct dfl_feature_ops port_stp_ops = {
  	.init = port_stp_init,
  };
09d861501   Xu Yilun   fpga: dfl: afu: a...
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
  static long
  port_uint_ioctl(struct platform_device *pdev, struct dfl_feature *feature,
  		unsigned int cmd, unsigned long arg)
  {
  	switch (cmd) {
  	case DFL_FPGA_PORT_UINT_GET_IRQ_NUM:
  		return dfl_feature_ioctl_get_num_irqs(pdev, feature, arg);
  	case DFL_FPGA_PORT_UINT_SET_IRQ:
  		return dfl_feature_ioctl_set_irq(pdev, feature, arg);
  	default:
  		dev_dbg(&pdev->dev, "%x cmd not handled", cmd);
  		return -ENODEV;
  	}
  }
  
  static const struct dfl_feature_id port_uint_id_table[] = {
  	{.id = PORT_FEATURE_ID_UINT,},
  	{0,}
  };
  
  static const struct dfl_feature_ops port_uint_ops = {
  	.ioctl = port_uint_ioctl,
  };
1a1527cf5   Wu Hao   fpga: dfl: add FP...
546
547
  static struct dfl_feature_driver port_feature_drvs[] = {
  	{
15bbb300f   Wu Hao   fpga: dfl: add id...
548
  		.id_table = port_hdr_id_table,
1a1527cf5   Wu Hao   fpga: dfl: add FP...
549
550
551
  		.ops = &port_hdr_ops,
  	},
  	{
15bbb300f   Wu Hao   fpga: dfl: add id...
552
  		.id_table = port_afu_id_table,
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
553
554
555
  		.ops = &port_afu_ops,
  	},
  	{
44d247534   Wu Hao   fpga: dfl: afu: a...
556
557
558
559
  		.id_table = port_err_id_table,
  		.ops = &port_err_ops,
  	},
  	{
bd127b819   Wu Hao   fpga: dfl: afu: a...
560
561
562
563
  		.id_table = port_stp_id_table,
  		.ops = &port_stp_ops,
  	},
  	{
09d861501   Xu Yilun   fpga: dfl: afu: a...
564
565
566
567
  		.id_table = port_uint_id_table,
  		.ops = &port_uint_ops,
  	},
  	{
1a1527cf5   Wu Hao   fpga: dfl: add FP...
568
569
570
571
572
573
574
575
576
577
578
579
580
  		.ops = NULL,
  	}
  };
  
  static int afu_open(struct inode *inode, struct file *filp)
  {
  	struct platform_device *fdev = dfl_fpga_inode_to_feature_dev(inode);
  	struct dfl_feature_platform_data *pdata;
  	int ret;
  
  	pdata = dev_get_platdata(&fdev->dev);
  	if (WARN_ON(!pdata))
  		return -ENODEV;
b6862193c   Xu Yilun   fpga: dfl: suppor...
581
582
583
584
585
586
587
588
589
  	mutex_lock(&pdata->lock);
  	ret = dfl_feature_dev_use_begin(pdata, filp->f_flags & O_EXCL);
  	if (!ret) {
  		dev_dbg(&fdev->dev, "Device File Opened %d Times
  ",
  			dfl_feature_dev_use_count(pdata));
  		filp->private_data = fdev;
  	}
  	mutex_unlock(&pdata->lock);
1a1527cf5   Wu Hao   fpga: dfl: add FP...
590

b6862193c   Xu Yilun   fpga: dfl: suppor...
591
  	return ret;
1a1527cf5   Wu Hao   fpga: dfl: add FP...
592
593
594
595
596
597
  }
  
  static int afu_release(struct inode *inode, struct file *filp)
  {
  	struct platform_device *pdev = filp->private_data;
  	struct dfl_feature_platform_data *pdata;
fe6a3d652   Xu Yilun   fpga: dfl: afu: a...
598
  	struct dfl_feature *feature;
1a1527cf5   Wu Hao   fpga: dfl: add FP...
599
600
601
602
603
  
  	dev_dbg(&pdev->dev, "Device File Release
  ");
  
  	pdata = dev_get_platdata(&pdev->dev);
fa8dda1ed   Wu Hao   fpga: dfl: afu: a...
604
  	mutex_lock(&pdata->lock);
1a1527cf5   Wu Hao   fpga: dfl: add FP...
605
  	dfl_feature_dev_use_end(pdata);
b6862193c   Xu Yilun   fpga: dfl: suppor...
606
  	if (!dfl_feature_dev_use_count(pdata)) {
fe6a3d652   Xu Yilun   fpga: dfl: afu: a...
607
608
609
  		dfl_fpga_dev_for_each_feature(pdata, feature)
  			dfl_fpga_set_irq_triggers(feature, 0,
  						  feature->nr_irqs, NULL);
b6862193c   Xu Yilun   fpga: dfl: suppor...
610
611
612
613
  		__port_reset(pdev);
  		afu_dma_region_destroy(pdata);
  	}
  	mutex_unlock(&pdata->lock);
1a1527cf5   Wu Hao   fpga: dfl: add FP...
614
615
  	return 0;
  }
6fd893c40   Wu Hao   fpga: dfl: afu: a...
616
617
618
619
620
621
  static long afu_ioctl_check_extension(struct dfl_feature_platform_data *pdata,
  				      unsigned long arg)
  {
  	/* No extension support for now */
  	return 0;
  }
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
622
623
624
625
626
627
628
629
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
653
654
655
656
657
658
659
660
661
662
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677
678
  static long
  afu_ioctl_get_info(struct dfl_feature_platform_data *pdata, void __user *arg)
  {
  	struct dfl_fpga_port_info info;
  	struct dfl_afu *afu;
  	unsigned long minsz;
  
  	minsz = offsetofend(struct dfl_fpga_port_info, num_umsgs);
  
  	if (copy_from_user(&info, arg, minsz))
  		return -EFAULT;
  
  	if (info.argsz < minsz)
  		return -EINVAL;
  
  	mutex_lock(&pdata->lock);
  	afu = dfl_fpga_pdata_get_private(pdata);
  	info.flags = 0;
  	info.num_regions = afu->num_regions;
  	info.num_umsgs = afu->num_umsgs;
  	mutex_unlock(&pdata->lock);
  
  	if (copy_to_user(arg, &info, sizeof(info)))
  		return -EFAULT;
  
  	return 0;
  }
  
  static long afu_ioctl_get_region_info(struct dfl_feature_platform_data *pdata,
  				      void __user *arg)
  {
  	struct dfl_fpga_port_region_info rinfo;
  	struct dfl_afu_mmio_region region;
  	unsigned long minsz;
  	long ret;
  
  	minsz = offsetofend(struct dfl_fpga_port_region_info, offset);
  
  	if (copy_from_user(&rinfo, arg, minsz))
  		return -EFAULT;
  
  	if (rinfo.argsz < minsz || rinfo.padding)
  		return -EINVAL;
  
  	ret = afu_mmio_region_get_by_index(pdata, rinfo.index, &region);
  	if (ret)
  		return ret;
  
  	rinfo.flags = region.flags;
  	rinfo.size = region.size;
  	rinfo.offset = region.offset;
  
  	if (copy_to_user(arg, &rinfo, sizeof(rinfo)))
  		return -EFAULT;
  
  	return 0;
  }
fa8dda1ed   Wu Hao   fpga: dfl: afu: a...
679
680
681
682
683
684
685
686
687
688
689
690
691
692
693
694
695
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713
714
715
716
717
718
719
720
721
722
723
724
725
726
727
  static long
  afu_ioctl_dma_map(struct dfl_feature_platform_data *pdata, void __user *arg)
  {
  	struct dfl_fpga_port_dma_map map;
  	unsigned long minsz;
  	long ret;
  
  	minsz = offsetofend(struct dfl_fpga_port_dma_map, iova);
  
  	if (copy_from_user(&map, arg, minsz))
  		return -EFAULT;
  
  	if (map.argsz < minsz || map.flags)
  		return -EINVAL;
  
  	ret = afu_dma_map_region(pdata, map.user_addr, map.length, &map.iova);
  	if (ret)
  		return ret;
  
  	if (copy_to_user(arg, &map, sizeof(map))) {
  		afu_dma_unmap_region(pdata, map.iova);
  		return -EFAULT;
  	}
  
  	dev_dbg(&pdata->dev->dev, "dma map: ua=%llx, len=%llx, iova=%llx
  ",
  		(unsigned long long)map.user_addr,
  		(unsigned long long)map.length,
  		(unsigned long long)map.iova);
  
  	return 0;
  }
  
  static long
  afu_ioctl_dma_unmap(struct dfl_feature_platform_data *pdata, void __user *arg)
  {
  	struct dfl_fpga_port_dma_unmap unmap;
  	unsigned long minsz;
  
  	minsz = offsetofend(struct dfl_fpga_port_dma_unmap, iova);
  
  	if (copy_from_user(&unmap, arg, minsz))
  		return -EFAULT;
  
  	if (unmap.argsz < minsz || unmap.flags)
  		return -EINVAL;
  
  	return afu_dma_unmap_region(pdata, unmap.iova);
  }
1a1527cf5   Wu Hao   fpga: dfl: add FP...
728
729
730
731
732
733
734
735
736
737
738
739
740
  static long afu_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
  {
  	struct platform_device *pdev = filp->private_data;
  	struct dfl_feature_platform_data *pdata;
  	struct dfl_feature *f;
  	long ret;
  
  	dev_dbg(&pdev->dev, "%s cmd 0x%x
  ", __func__, cmd);
  
  	pdata = dev_get_platdata(&pdev->dev);
  
  	switch (cmd) {
6fd893c40   Wu Hao   fpga: dfl: afu: a...
741
742
743
744
  	case DFL_FPGA_GET_API_VERSION:
  		return DFL_FPGA_API_VERSION;
  	case DFL_FPGA_CHECK_EXTENSION:
  		return afu_ioctl_check_extension(pdata, arg);
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
745
746
747
748
  	case DFL_FPGA_PORT_GET_INFO:
  		return afu_ioctl_get_info(pdata, (void __user *)arg);
  	case DFL_FPGA_PORT_GET_REGION_INFO:
  		return afu_ioctl_get_region_info(pdata, (void __user *)arg);
fa8dda1ed   Wu Hao   fpga: dfl: afu: a...
749
750
751
752
  	case DFL_FPGA_PORT_DMA_MAP:
  		return afu_ioctl_dma_map(pdata, (void __user *)arg);
  	case DFL_FPGA_PORT_DMA_UNMAP:
  		return afu_ioctl_dma_unmap(pdata, (void __user *)arg);
1a1527cf5   Wu Hao   fpga: dfl: add FP...
753
754
755
756
757
758
759
760
761
762
763
764
765
766
767
768
769
  	default:
  		/*
  		 * Let sub-feature's ioctl function to handle the cmd
  		 * Sub-feature's ioctl returns -ENODEV when cmd is not
  		 * handled in this sub feature, and returns 0 and other
  		 * error code if cmd is handled.
  		 */
  		dfl_fpga_dev_for_each_feature(pdata, f)
  			if (f->ops && f->ops->ioctl) {
  				ret = f->ops->ioctl(pdev, f, cmd, arg);
  				if (ret != -ENODEV)
  					return ret;
  			}
  	}
  
  	return -EINVAL;
  }
a2b9d4ead   Dominic Chen   fpga: dfl: afu: s...
770
771
772
773
774
  static const struct vm_operations_struct afu_vma_ops = {
  #ifdef CONFIG_HAVE_IOREMAP_PROT
  	.access = generic_access_phys,
  #endif
  };
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
775
776
777
778
779
780
781
782
783
784
785
786
787
788
789
790
791
792
793
794
795
796
797
798
799
800
801
802
  static int afu_mmap(struct file *filp, struct vm_area_struct *vma)
  {
  	struct platform_device *pdev = filp->private_data;
  	struct dfl_feature_platform_data *pdata;
  	u64 size = vma->vm_end - vma->vm_start;
  	struct dfl_afu_mmio_region region;
  	u64 offset;
  	int ret;
  
  	if (!(vma->vm_flags & VM_SHARED))
  		return -EINVAL;
  
  	pdata = dev_get_platdata(&pdev->dev);
  
  	offset = vma->vm_pgoff << PAGE_SHIFT;
  	ret = afu_mmio_region_get_by_offset(pdata, offset, size, &region);
  	if (ret)
  		return ret;
  
  	if (!(region.flags & DFL_PORT_REGION_MMAP))
  		return -EINVAL;
  
  	if ((vma->vm_flags & VM_READ) && !(region.flags & DFL_PORT_REGION_READ))
  		return -EPERM;
  
  	if ((vma->vm_flags & VM_WRITE) &&
  	    !(region.flags & DFL_PORT_REGION_WRITE))
  		return -EPERM;
a2b9d4ead   Dominic Chen   fpga: dfl: afu: s...
803
804
  	/* Support debug access to the mapping */
  	vma->vm_ops = &afu_vma_ops;
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
805
806
807
808
809
810
  	vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
  
  	return remap_pfn_range(vma, vma->vm_start,
  			(region.phys + (offset - region.offset)) >> PAGE_SHIFT,
  			size, vma->vm_page_prot);
  }
1a1527cf5   Wu Hao   fpga: dfl: add FP...
811
812
813
814
815
  static const struct file_operations afu_fops = {
  	.owner = THIS_MODULE,
  	.open = afu_open,
  	.release = afu_release,
  	.unlocked_ioctl = afu_ioctl,
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
816
  	.mmap = afu_mmap,
1a1527cf5   Wu Hao   fpga: dfl: add FP...
817
  };
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
818
819
820
821
822
823
824
825
826
827
828
829
830
831
  static int afu_dev_init(struct platform_device *pdev)
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(&pdev->dev);
  	struct dfl_afu *afu;
  
  	afu = devm_kzalloc(&pdev->dev, sizeof(*afu), GFP_KERNEL);
  	if (!afu)
  		return -ENOMEM;
  
  	afu->pdata = pdata;
  
  	mutex_lock(&pdata->lock);
  	dfl_fpga_pdata_set_private(pdata, afu);
  	afu_mmio_region_init(pdata);
fa8dda1ed   Wu Hao   fpga: dfl: afu: a...
832
  	afu_dma_region_init(pdata);
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
833
834
835
836
837
838
839
840
  	mutex_unlock(&pdata->lock);
  
  	return 0;
  }
  
  static int afu_dev_destroy(struct platform_device *pdev)
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(&pdev->dev);
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
841
842
  
  	mutex_lock(&pdata->lock);
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
843
  	afu_mmio_region_destroy(pdata);
fa8dda1ed   Wu Hao   fpga: dfl: afu: a...
844
  	afu_dma_region_destroy(pdata);
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
845
846
847
848
849
  	dfl_fpga_pdata_set_private(pdata, NULL);
  	mutex_unlock(&pdata->lock);
  
  	return 0;
  }
47c1b19c1   Wu Hao   fpga: dfl: afu: a...
850
851
852
853
854
855
856
  static int port_enable_set(struct platform_device *pdev, bool enable)
  {
  	struct dfl_feature_platform_data *pdata = dev_get_platdata(&pdev->dev);
  	int ret = 0;
  
  	mutex_lock(&pdata->lock);
  	if (enable)
95844372f   Wu Hao   fpga: dfl: afu: e...
857
  		__afu_port_enable(pdev);
47c1b19c1   Wu Hao   fpga: dfl: afu: a...
858
  	else
95844372f   Wu Hao   fpga: dfl: afu: e...
859
  		ret = __afu_port_disable(pdev);
47c1b19c1   Wu Hao   fpga: dfl: afu: a...
860
861
862
863
864
865
866
867
868
869
870
  	mutex_unlock(&pdata->lock);
  
  	return ret;
  }
  
  static struct dfl_fpga_port_ops afu_port_ops = {
  	.name = DFL_FPGA_FEATURE_DEV_PORT,
  	.owner = THIS_MODULE,
  	.get_id = port_get_id,
  	.enable_set = port_enable_set,
  };
1a1527cf5   Wu Hao   fpga: dfl: add FP...
871
872
873
874
875
876
  static int afu_probe(struct platform_device *pdev)
  {
  	int ret;
  
  	dev_dbg(&pdev->dev, "%s
  ", __func__);
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
877
878
879
  	ret = afu_dev_init(pdev);
  	if (ret)
  		goto exit;
1a1527cf5   Wu Hao   fpga: dfl: add FP...
880
881
  	ret = dfl_fpga_dev_feature_init(pdev, port_feature_drvs);
  	if (ret)
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
882
  		goto dev_destroy;
1a1527cf5   Wu Hao   fpga: dfl: add FP...
883
884
  
  	ret = dfl_fpga_dev_ops_register(pdev, &afu_fops, THIS_MODULE);
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
885
  	if (ret) {
1a1527cf5   Wu Hao   fpga: dfl: add FP...
886
  		dfl_fpga_dev_feature_uinit(pdev);
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
887
888
889
890
  		goto dev_destroy;
  	}
  
  	return 0;
1a1527cf5   Wu Hao   fpga: dfl: add FP...
891

857a26222   Xiao Guangrong   fpga: dfl: afu: a...
892
893
894
  dev_destroy:
  	afu_dev_destroy(pdev);
  exit:
1a1527cf5   Wu Hao   fpga: dfl: add FP...
895
896
897
898
899
900
901
902
903
904
  	return ret;
  }
  
  static int afu_remove(struct platform_device *pdev)
  {
  	dev_dbg(&pdev->dev, "%s
  ", __func__);
  
  	dfl_fpga_dev_ops_unregister(pdev);
  	dfl_fpga_dev_feature_uinit(pdev);
857a26222   Xiao Guangrong   fpga: dfl: afu: a...
905
  	afu_dev_destroy(pdev);
1a1527cf5   Wu Hao   fpga: dfl: add FP...
906
907
908
  
  	return 0;
  }
a80a4b82e   Wu Hao   fpga: dfl: afu: c...
909
910
911
  static const struct attribute_group *afu_dev_groups[] = {
  	&port_hdr_group,
  	&port_afu_group,
44d247534   Wu Hao   fpga: dfl: afu: a...
912
  	&port_err_group,
a80a4b82e   Wu Hao   fpga: dfl: afu: c...
913
914
  	NULL
  };
1a1527cf5   Wu Hao   fpga: dfl: add FP...
915
916
  static struct platform_driver afu_driver = {
  	.driver	= {
a80a4b82e   Wu Hao   fpga: dfl: afu: c...
917
918
  		.name	    = DFL_FPGA_FEATURE_DEV_PORT,
  		.dev_groups = afu_dev_groups,
1a1527cf5   Wu Hao   fpga: dfl: add FP...
919
920
921
922
  	},
  	.probe   = afu_probe,
  	.remove  = afu_remove,
  };
47c1b19c1   Wu Hao   fpga: dfl: afu: a...
923
924
925
926
927
928
929
930
931
932
933
934
935
936
937
938
939
940
941
942
943
944
  static int __init afu_init(void)
  {
  	int ret;
  
  	dfl_fpga_port_ops_add(&afu_port_ops);
  
  	ret = platform_driver_register(&afu_driver);
  	if (ret)
  		dfl_fpga_port_ops_del(&afu_port_ops);
  
  	return ret;
  }
  
  static void __exit afu_exit(void)
  {
  	platform_driver_unregister(&afu_driver);
  
  	dfl_fpga_port_ops_del(&afu_port_ops);
  }
  
  module_init(afu_init);
  module_exit(afu_exit);
1a1527cf5   Wu Hao   fpga: dfl: add FP...
945
946
947
948
949
  
  MODULE_DESCRIPTION("FPGA Accelerated Function Unit driver");
  MODULE_AUTHOR("Intel Corporation");
  MODULE_LICENSE("GPL v2");
  MODULE_ALIAS("platform:dfl-port");