1 // SPDX-License-Identifier: GPL-2.0
3 * Driver for FPGA Management Engine (FME) Partial Reconfiguration
5 * Copyright (C) 2017-2018 Intel Corporation, Inc.
8 * Kang Luwei <luwei.kang@intel.com>
9 * Xiao Guangrong <guangrong.xiao@linux.intel.com>
10 * Wu Hao <hao.wu@intel.com>
11 * Joseph Grecco <joe.grecco@intel.com>
12 * Enno Luebbers <enno.luebbers@intel.com>
13 * Tim Whisonant <tim.whisonant@intel.com>
14 * Ananda Ravuri <ananda.ravuri@intel.com>
15 * Christopher Rauer <christopher.rauer@intel.com>
16 * Henry Mitchel <henry.mitchel@intel.com>
19 #include <linux/types.h>
20 #include <linux/device.h>
21 #include <linux/vmalloc.h>
22 #include <linux/uaccess.h>
23 #include <linux/fpga/fpga-mgr.h>
24 #include <linux/fpga/fpga-bridge.h>
25 #include <linux/fpga/fpga-region.h>
26 #include <linux/fpga-dfl.h>
30 #include "dfl-fme-pr.h"
32 static struct dfl_fme_region
*
33 dfl_fme_region_find_by_port_id(struct dfl_fme
*fme
, int port_id
)
35 struct dfl_fme_region
*fme_region
;
37 list_for_each_entry(fme_region
, &fme
->region_list
, node
)
38 if (fme_region
->port_id
== port_id
)
44 static int dfl_fme_region_match(struct device
*dev
, const void *data
)
46 return dev
->parent
== data
;
49 static struct fpga_region
*dfl_fme_region_find(struct dfl_fme
*fme
, int port_id
)
51 struct dfl_fme_region
*fme_region
;
52 struct fpga_region
*region
;
54 fme_region
= dfl_fme_region_find_by_port_id(fme
, port_id
);
58 region
= fpga_region_class_find(NULL
, &fme_region
->region
->dev
,
59 dfl_fme_region_match
);
66 static int fme_pr(struct platform_device
*pdev
, unsigned long arg
)
68 struct dfl_feature_platform_data
*pdata
= dev_get_platdata(&pdev
->dev
);
69 void __user
*argp
= (void __user
*)arg
;
70 struct dfl_fpga_fme_port_pr port_pr
;
71 struct fpga_image_info
*info
;
72 struct fpga_region
*region
;
73 void __iomem
*fme_hdr
;
80 minsz
= offsetofend(struct dfl_fpga_fme_port_pr
, buffer_address
);
82 if (copy_from_user(&port_pr
, argp
, minsz
))
85 if (port_pr
.argsz
< minsz
|| port_pr
.flags
)
88 if (!IS_ALIGNED(port_pr
.buffer_size
, 4))
91 /* get fme header region */
92 fme_hdr
= dfl_get_feature_ioaddr_by_id(&pdev
->dev
,
93 FME_FEATURE_ID_HEADER
);
96 v
= readq(fme_hdr
+ FME_HDR_CAP
);
97 if (port_pr
.port_id
>= FIELD_GET(FME_CAP_NUM_PORTS
, v
)) {
98 dev_dbg(&pdev
->dev
, "port number more than maximum\n");
102 if (!access_ok((void __user
*)(unsigned long)port_pr
.buffer_address
,
103 port_pr
.buffer_size
))
106 buf
= vmalloc(port_pr
.buffer_size
);
110 if (copy_from_user(buf
,
111 (void __user
*)(unsigned long)port_pr
.buffer_address
,
112 port_pr
.buffer_size
)) {
117 /* prepare fpga_image_info for PR */
118 info
= fpga_image_info_alloc(&pdev
->dev
);
124 info
->flags
|= FPGA_MGR_PARTIAL_RECONFIG
;
126 mutex_lock(&pdata
->lock
);
127 fme
= dfl_fpga_pdata_get_private(pdata
);
128 /* fme device has been unregistered. */
134 region
= dfl_fme_region_find(fme
, port_pr
.port_id
);
140 fpga_image_info_free(region
->info
);
143 info
->count
= port_pr
.buffer_size
;
144 info
->region_id
= port_pr
.port_id
;
147 ret
= fpga_region_program_fpga(region
);
150 * it allows userspace to reset the PR region's logic by disabling and
151 * reenabling the bridge to clear things out between accleration runs.
152 * so no need to hold the bridges after partial reconfiguration.
154 if (region
->get_bridges
)
155 fpga_bridges_put(®ion
->bridge_list
);
157 put_device(®ion
->dev
);
159 mutex_unlock(&pdata
->lock
);
162 if (copy_to_user((void __user
*)arg
, &port_pr
, minsz
))
169 * dfl_fme_create_mgr - create fpga mgr platform device as child device
171 * @pdata: fme platform_device's pdata
173 * Return: mgr platform device if successful, and error code otherwise.
175 static struct platform_device
*
176 dfl_fme_create_mgr(struct dfl_feature_platform_data
*pdata
,
177 struct dfl_feature
*feature
)
179 struct platform_device
*mgr
, *fme
= pdata
->dev
;
180 struct dfl_fme_mgr_pdata mgr_pdata
;
183 if (!feature
->ioaddr
)
184 return ERR_PTR(-ENODEV
);
186 mgr_pdata
.ioaddr
= feature
->ioaddr
;
189 * Each FME has only one fpga-mgr, so allocate platform device using
190 * the same FME platform device id.
192 mgr
= platform_device_alloc(DFL_FPGA_FME_MGR
, fme
->id
);
196 mgr
->dev
.parent
= &fme
->dev
;
198 ret
= platform_device_add_data(mgr
, &mgr_pdata
, sizeof(mgr_pdata
));
202 ret
= platform_device_add(mgr
);
209 platform_device_put(mgr
);
214 * dfl_fme_destroy_mgr - destroy fpga mgr platform device
215 * @pdata: fme platform device's pdata
217 static void dfl_fme_destroy_mgr(struct dfl_feature_platform_data
*pdata
)
219 struct dfl_fme
*priv
= dfl_fpga_pdata_get_private(pdata
);
221 platform_device_unregister(priv
->mgr
);
225 * dfl_fme_create_bridge - create fme fpga bridge platform device as child
227 * @pdata: fme platform device's pdata
228 * @port_id: port id for the bridge to be created.
230 * Return: bridge platform device if successful, and error code otherwise.
232 static struct dfl_fme_bridge
*
233 dfl_fme_create_bridge(struct dfl_feature_platform_data
*pdata
, int port_id
)
235 struct device
*dev
= &pdata
->dev
->dev
;
236 struct dfl_fme_br_pdata br_pdata
;
237 struct dfl_fme_bridge
*fme_br
;
240 fme_br
= devm_kzalloc(dev
, sizeof(*fme_br
), GFP_KERNEL
);
244 br_pdata
.cdev
= pdata
->dfl_cdev
;
245 br_pdata
.port_id
= port_id
;
247 fme_br
->br
= platform_device_alloc(DFL_FPGA_FME_BRIDGE
,
248 PLATFORM_DEVID_AUTO
);
252 fme_br
->br
->dev
.parent
= dev
;
254 ret
= platform_device_add_data(fme_br
->br
, &br_pdata
, sizeof(br_pdata
));
258 ret
= platform_device_add(fme_br
->br
);
265 platform_device_put(fme_br
->br
);
270 * dfl_fme_destroy_bridge - destroy fpga bridge platform device
271 * @fme_br: fme bridge to destroy
273 static void dfl_fme_destroy_bridge(struct dfl_fme_bridge
*fme_br
)
275 platform_device_unregister(fme_br
->br
);
279 * dfl_fme_destroy_bridge - destroy all fpga bridge platform device
280 * @pdata: fme platform device's pdata
282 static void dfl_fme_destroy_bridges(struct dfl_feature_platform_data
*pdata
)
284 struct dfl_fme
*priv
= dfl_fpga_pdata_get_private(pdata
);
285 struct dfl_fme_bridge
*fbridge
, *tmp
;
287 list_for_each_entry_safe(fbridge
, tmp
, &priv
->bridge_list
, node
) {
288 list_del(&fbridge
->node
);
289 dfl_fme_destroy_bridge(fbridge
);
294 * dfl_fme_create_region - create fpga region platform device as child
296 * @pdata: fme platform device's pdata
297 * @mgr: mgr platform device needed for region
298 * @br: br platform device needed for region
301 * Return: fme region if successful, and error code otherwise.
303 static struct dfl_fme_region
*
304 dfl_fme_create_region(struct dfl_feature_platform_data
*pdata
,
305 struct platform_device
*mgr
,
306 struct platform_device
*br
, int port_id
)
308 struct dfl_fme_region_pdata region_pdata
;
309 struct device
*dev
= &pdata
->dev
->dev
;
310 struct dfl_fme_region
*fme_region
;
313 fme_region
= devm_kzalloc(dev
, sizeof(*fme_region
), GFP_KERNEL
);
317 region_pdata
.mgr
= mgr
;
318 region_pdata
.br
= br
;
321 * Each FPGA device may have more than one port, so allocate platform
322 * device using the same port platform device id.
324 fme_region
->region
= platform_device_alloc(DFL_FPGA_FME_REGION
, br
->id
);
325 if (!fme_region
->region
)
328 fme_region
->region
->dev
.parent
= dev
;
330 ret
= platform_device_add_data(fme_region
->region
, ®ion_pdata
,
331 sizeof(region_pdata
));
333 goto create_region_err
;
335 ret
= platform_device_add(fme_region
->region
);
337 goto create_region_err
;
339 fme_region
->port_id
= port_id
;
344 platform_device_put(fme_region
->region
);
349 * dfl_fme_destroy_region - destroy fme region
350 * @fme_region: fme region to destroy
352 static void dfl_fme_destroy_region(struct dfl_fme_region
*fme_region
)
354 platform_device_unregister(fme_region
->region
);
358 * dfl_fme_destroy_regions - destroy all fme regions
359 * @pdata: fme platform device's pdata
361 static void dfl_fme_destroy_regions(struct dfl_feature_platform_data
*pdata
)
363 struct dfl_fme
*priv
= dfl_fpga_pdata_get_private(pdata
);
364 struct dfl_fme_region
*fme_region
, *tmp
;
366 list_for_each_entry_safe(fme_region
, tmp
, &priv
->region_list
, node
) {
367 list_del(&fme_region
->node
);
368 dfl_fme_destroy_region(fme_region
);
372 static int pr_mgmt_init(struct platform_device
*pdev
,
373 struct dfl_feature
*feature
)
375 struct dfl_feature_platform_data
*pdata
= dev_get_platdata(&pdev
->dev
);
376 struct dfl_fme_region
*fme_region
;
377 struct dfl_fme_bridge
*fme_br
;
378 struct platform_device
*mgr
;
379 struct dfl_fme
*priv
;
380 void __iomem
*fme_hdr
;
381 int ret
= -ENODEV
, i
= 0;
382 u64 fme_cap
, port_offset
;
384 fme_hdr
= dfl_get_feature_ioaddr_by_id(&pdev
->dev
,
385 FME_FEATURE_ID_HEADER
);
387 mutex_lock(&pdata
->lock
);
388 priv
= dfl_fpga_pdata_get_private(pdata
);
390 /* Initialize the region and bridge sub device list */
391 INIT_LIST_HEAD(&priv
->region_list
);
392 INIT_LIST_HEAD(&priv
->bridge_list
);
394 /* Create fpga mgr platform device */
395 mgr
= dfl_fme_create_mgr(pdata
, feature
);
397 dev_err(&pdev
->dev
, "fail to create fpga mgr pdev\n");
403 /* Read capability register to check number of regions and bridges */
404 fme_cap
= readq(fme_hdr
+ FME_HDR_CAP
);
405 for (; i
< FIELD_GET(FME_CAP_NUM_PORTS
, fme_cap
); i
++) {
406 port_offset
= readq(fme_hdr
+ FME_HDR_PORT_OFST(i
));
407 if (!(port_offset
& FME_PORT_OFST_IMP
))
410 /* Create bridge for each port */
411 fme_br
= dfl_fme_create_bridge(pdata
, i
);
412 if (IS_ERR(fme_br
)) {
413 ret
= PTR_ERR(fme_br
);
417 list_add(&fme_br
->node
, &priv
->bridge_list
);
419 /* Create region for each port */
420 fme_region
= dfl_fme_create_region(pdata
, mgr
,
422 if (IS_ERR(fme_region
)) {
423 ret
= PTR_ERR(fme_region
);
427 list_add(&fme_region
->node
, &priv
->region_list
);
429 mutex_unlock(&pdata
->lock
);
434 dfl_fme_destroy_regions(pdata
);
435 dfl_fme_destroy_bridges(pdata
);
436 dfl_fme_destroy_mgr(pdata
);
438 mutex_unlock(&pdata
->lock
);
442 static void pr_mgmt_uinit(struct platform_device
*pdev
,
443 struct dfl_feature
*feature
)
445 struct dfl_feature_platform_data
*pdata
= dev_get_platdata(&pdev
->dev
);
447 mutex_lock(&pdata
->lock
);
449 dfl_fme_destroy_regions(pdata
);
450 dfl_fme_destroy_bridges(pdata
);
451 dfl_fme_destroy_mgr(pdata
);
452 mutex_unlock(&pdata
->lock
);
455 static long fme_pr_ioctl(struct platform_device
*pdev
,
456 struct dfl_feature
*feature
,
457 unsigned int cmd
, unsigned long arg
)
462 case DFL_FPGA_FME_PORT_PR
:
463 ret
= fme_pr(pdev
, arg
);
472 const struct dfl_feature_ops pr_mgmt_ops
= {
473 .init
= pr_mgmt_init
,
474 .uinit
= pr_mgmt_uinit
,
475 .ioctl
= fme_pr_ioctl
,