1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * FPGA Manager Core
4 *
5 * Copyright (C) 2013-2015 Altera Corporation
6 * Copyright (C) 2017 Intel Corporation
7 *
8 * With code from the mailing list:
9 * Copyright (C) 2013 Xilinx, Inc.
10 */
11 #include <linux/firmware.h>
12 #include <linux/fpga/fpga-mgr.h>
13 #include <linux/idr.h>
14 #include <linux/module.h>
15 #include <linux/of.h>
16 #include <linux/mutex.h>
17 #include <linux/slab.h>
18 #include <linux/scatterlist.h>
19 #include <linux/highmem.h>
20
21 static DEFINE_IDA(fpga_mgr_ida);
22 static struct class *fpga_mgr_class;
23
24 struct fpga_mgr_devres {
25 struct fpga_manager *mgr;
26 };
27
fpga_mgr_fpga_remove(struct fpga_manager * mgr)28 static inline void fpga_mgr_fpga_remove(struct fpga_manager *mgr)
29 {
30 if (mgr->mops->fpga_remove)
31 mgr->mops->fpga_remove(mgr);
32 }
33
fpga_mgr_state(struct fpga_manager * mgr)34 static inline enum fpga_mgr_states fpga_mgr_state(struct fpga_manager *mgr)
35 {
36 if (mgr->mops->state)
37 return mgr->mops->state(mgr);
38 return FPGA_MGR_STATE_UNKNOWN;
39 }
40
fpga_mgr_status(struct fpga_manager * mgr)41 static inline u64 fpga_mgr_status(struct fpga_manager *mgr)
42 {
43 if (mgr->mops->status)
44 return mgr->mops->status(mgr);
45 return 0;
46 }
47
fpga_mgr_write(struct fpga_manager * mgr,const char * buf,size_t count)48 static inline int fpga_mgr_write(struct fpga_manager *mgr, const char *buf, size_t count)
49 {
50 if (mgr->mops->write)
51 return mgr->mops->write(mgr, buf, count);
52 return -EOPNOTSUPP;
53 }
54
55 /*
56 * After all the FPGA image has been written, do the device specific steps to
57 * finish and set the FPGA into operating mode.
58 */
fpga_mgr_write_complete(struct fpga_manager * mgr,struct fpga_image_info * info)59 static inline int fpga_mgr_write_complete(struct fpga_manager *mgr,
60 struct fpga_image_info *info)
61 {
62 int ret = 0;
63
64 mgr->state = FPGA_MGR_STATE_WRITE_COMPLETE;
65 if (mgr->mops->write_complete)
66 ret = mgr->mops->write_complete(mgr, info);
67 if (ret) {
68 dev_err(&mgr->dev, "Error after writing image data to FPGA\n");
69 mgr->state = FPGA_MGR_STATE_WRITE_COMPLETE_ERR;
70 return ret;
71 }
72 mgr->state = FPGA_MGR_STATE_OPERATING;
73
74 return 0;
75 }
76
fpga_mgr_write_init(struct fpga_manager * mgr,struct fpga_image_info * info,const char * buf,size_t count)77 static inline int fpga_mgr_write_init(struct fpga_manager *mgr,
78 struct fpga_image_info *info,
79 const char *buf, size_t count)
80 {
81 if (mgr->mops->write_init)
82 return mgr->mops->write_init(mgr, info, buf, count);
83 return 0;
84 }
85
fpga_mgr_write_sg(struct fpga_manager * mgr,struct sg_table * sgt)86 static inline int fpga_mgr_write_sg(struct fpga_manager *mgr,
87 struct sg_table *sgt)
88 {
89 if (mgr->mops->write_sg)
90 return mgr->mops->write_sg(mgr, sgt);
91 return -EOPNOTSUPP;
92 }
93
94 /**
95 * fpga_image_info_alloc - Allocate an FPGA image info struct
96 * @dev: owning device
97 *
98 * Return: struct fpga_image_info or NULL
99 */
fpga_image_info_alloc(struct device * dev)100 struct fpga_image_info *fpga_image_info_alloc(struct device *dev)
101 {
102 struct fpga_image_info *info;
103
104 get_device(dev);
105
106 info = devm_kzalloc(dev, sizeof(*info), GFP_KERNEL);
107 if (!info) {
108 put_device(dev);
109 return NULL;
110 }
111
112 info->dev = dev;
113
114 return info;
115 }
116 EXPORT_SYMBOL_GPL(fpga_image_info_alloc);
117
118 /**
119 * fpga_image_info_free - Free an FPGA image info struct
120 * @info: FPGA image info struct to free
121 */
fpga_image_info_free(struct fpga_image_info * info)122 void fpga_image_info_free(struct fpga_image_info *info)
123 {
124 struct device *dev;
125
126 if (!info)
127 return;
128
129 dev = info->dev;
130 if (info->firmware_name)
131 devm_kfree(dev, info->firmware_name);
132
133 devm_kfree(dev, info);
134 put_device(dev);
135 }
136 EXPORT_SYMBOL_GPL(fpga_image_info_free);
137
138 /*
139 * Call the low level driver's write_init function. This will do the
140 * device-specific things to get the FPGA into the state where it is ready to
141 * receive an FPGA image. The low level driver only gets to see the first
142 * initial_header_size bytes in the buffer.
143 */
fpga_mgr_write_init_buf(struct fpga_manager * mgr,struct fpga_image_info * info,const char * buf,size_t count)144 static int fpga_mgr_write_init_buf(struct fpga_manager *mgr,
145 struct fpga_image_info *info,
146 const char *buf, size_t count)
147 {
148 int ret;
149
150 mgr->state = FPGA_MGR_STATE_WRITE_INIT;
151 if (!mgr->mops->initial_header_size)
152 ret = fpga_mgr_write_init(mgr, info, NULL, 0);
153 else
154 ret = fpga_mgr_write_init(
155 mgr, info, buf, min(mgr->mops->initial_header_size, count));
156
157 if (ret) {
158 dev_err(&mgr->dev, "Error preparing FPGA for writing\n");
159 mgr->state = FPGA_MGR_STATE_WRITE_INIT_ERR;
160 return ret;
161 }
162
163 return 0;
164 }
165
fpga_mgr_write_init_sg(struct fpga_manager * mgr,struct fpga_image_info * info,struct sg_table * sgt)166 static int fpga_mgr_write_init_sg(struct fpga_manager *mgr,
167 struct fpga_image_info *info,
168 struct sg_table *sgt)
169 {
170 struct sg_mapping_iter miter;
171 size_t len;
172 char *buf;
173 int ret;
174
175 if (!mgr->mops->initial_header_size)
176 return fpga_mgr_write_init_buf(mgr, info, NULL, 0);
177
178 /*
179 * First try to use miter to map the first fragment to access the
180 * header, this is the typical path.
181 */
182 sg_miter_start(&miter, sgt->sgl, sgt->nents, SG_MITER_FROM_SG);
183 if (sg_miter_next(&miter) &&
184 miter.length >= mgr->mops->initial_header_size) {
185 ret = fpga_mgr_write_init_buf(mgr, info, miter.addr,
186 miter.length);
187 sg_miter_stop(&miter);
188 return ret;
189 }
190 sg_miter_stop(&miter);
191
192 /* Otherwise copy the fragments into temporary memory. */
193 buf = kmalloc(mgr->mops->initial_header_size, GFP_KERNEL);
194 if (!buf)
195 return -ENOMEM;
196
197 len = sg_copy_to_buffer(sgt->sgl, sgt->nents, buf,
198 mgr->mops->initial_header_size);
199 ret = fpga_mgr_write_init_buf(mgr, info, buf, len);
200
201 kfree(buf);
202
203 return ret;
204 }
205
206 /**
207 * fpga_mgr_buf_load_sg - load fpga from image in buffer from a scatter list
208 * @mgr: fpga manager
209 * @info: fpga image specific information
210 * @sgt: scatterlist table
211 *
212 * Step the low level fpga manager through the device-specific steps of getting
213 * an FPGA ready to be configured, writing the image to it, then doing whatever
214 * post-configuration steps necessary. This code assumes the caller got the
215 * mgr pointer from of_fpga_mgr_get() or fpga_mgr_get() and checked that it is
216 * not an error code.
217 *
218 * This is the preferred entry point for FPGA programming, it does not require
219 * any contiguous kernel memory.
220 *
221 * Return: 0 on success, negative error code otherwise.
222 */
fpga_mgr_buf_load_sg(struct fpga_manager * mgr,struct fpga_image_info * info,struct sg_table * sgt)223 static int fpga_mgr_buf_load_sg(struct fpga_manager *mgr,
224 struct fpga_image_info *info,
225 struct sg_table *sgt)
226 {
227 int ret;
228
229 ret = fpga_mgr_write_init_sg(mgr, info, sgt);
230 if (ret)
231 return ret;
232
233 /* Write the FPGA image to the FPGA. */
234 mgr->state = FPGA_MGR_STATE_WRITE;
235 if (mgr->mops->write_sg) {
236 ret = fpga_mgr_write_sg(mgr, sgt);
237 } else {
238 struct sg_mapping_iter miter;
239
240 sg_miter_start(&miter, sgt->sgl, sgt->nents, SG_MITER_FROM_SG);
241 while (sg_miter_next(&miter)) {
242 ret = fpga_mgr_write(mgr, miter.addr, miter.length);
243 if (ret)
244 break;
245 }
246 sg_miter_stop(&miter);
247 }
248
249 if (ret) {
250 dev_err(&mgr->dev, "Error while writing image data to FPGA\n");
251 mgr->state = FPGA_MGR_STATE_WRITE_ERR;
252 return ret;
253 }
254
255 return fpga_mgr_write_complete(mgr, info);
256 }
257
fpga_mgr_buf_load_mapped(struct fpga_manager * mgr,struct fpga_image_info * info,const char * buf,size_t count)258 static int fpga_mgr_buf_load_mapped(struct fpga_manager *mgr,
259 struct fpga_image_info *info,
260 const char *buf, size_t count)
261 {
262 int ret;
263
264 ret = fpga_mgr_write_init_buf(mgr, info, buf, count);
265 if (ret)
266 return ret;
267
268 /*
269 * Write the FPGA image to the FPGA.
270 */
271 mgr->state = FPGA_MGR_STATE_WRITE;
272 ret = fpga_mgr_write(mgr, buf, count);
273 if (ret) {
274 dev_err(&mgr->dev, "Error while writing image data to FPGA\n");
275 mgr->state = FPGA_MGR_STATE_WRITE_ERR;
276 return ret;
277 }
278
279 return fpga_mgr_write_complete(mgr, info);
280 }
281
282 /**
283 * fpga_mgr_buf_load - load fpga from image in buffer
284 * @mgr: fpga manager
285 * @info: fpga image info
286 * @buf: buffer contain fpga image
287 * @count: byte count of buf
288 *
289 * Step the low level fpga manager through the device-specific steps of getting
290 * an FPGA ready to be configured, writing the image to it, then doing whatever
291 * post-configuration steps necessary. This code assumes the caller got the
292 * mgr pointer from of_fpga_mgr_get() and checked that it is not an error code.
293 *
294 * Return: 0 on success, negative error code otherwise.
295 */
fpga_mgr_buf_load(struct fpga_manager * mgr,struct fpga_image_info * info,const char * buf,size_t count)296 static int fpga_mgr_buf_load(struct fpga_manager *mgr,
297 struct fpga_image_info *info,
298 const char *buf, size_t count)
299 {
300 struct page **pages;
301 struct sg_table sgt;
302 const void *p;
303 int nr_pages;
304 int index;
305 int rc;
306
307 /*
308 * This is just a fast path if the caller has already created a
309 * contiguous kernel buffer and the driver doesn't require SG, non-SG
310 * drivers will still work on the slow path.
311 */
312 if (mgr->mops->write)
313 return fpga_mgr_buf_load_mapped(mgr, info, buf, count);
314
315 /*
316 * Convert the linear kernel pointer into a sg_table of pages for use
317 * by the driver.
318 */
319 nr_pages = DIV_ROUND_UP((unsigned long)buf + count, PAGE_SIZE) -
320 (unsigned long)buf / PAGE_SIZE;
321 pages = kmalloc_array(nr_pages, sizeof(struct page *), GFP_KERNEL);
322 if (!pages)
323 return -ENOMEM;
324
325 p = buf - offset_in_page(buf);
326 for (index = 0; index < nr_pages; index++) {
327 if (is_vmalloc_addr(p))
328 pages[index] = vmalloc_to_page(p);
329 else
330 pages[index] = kmap_to_page((void *)p);
331 if (!pages[index]) {
332 kfree(pages);
333 return -EFAULT;
334 }
335 p += PAGE_SIZE;
336 }
337
338 /*
339 * The temporary pages list is used to code share the merging algorithm
340 * in sg_alloc_table_from_pages
341 */
342 rc = sg_alloc_table_from_pages(&sgt, pages, index, offset_in_page(buf),
343 count, GFP_KERNEL);
344 kfree(pages);
345 if (rc)
346 return rc;
347
348 rc = fpga_mgr_buf_load_sg(mgr, info, &sgt);
349 sg_free_table(&sgt);
350
351 return rc;
352 }
353
354 /**
355 * fpga_mgr_firmware_load - request firmware and load to fpga
356 * @mgr: fpga manager
357 * @info: fpga image specific information
358 * @image_name: name of image file on the firmware search path
359 *
360 * Request an FPGA image using the firmware class, then write out to the FPGA.
361 * Update the state before each step to provide info on what step failed if
362 * there is a failure. This code assumes the caller got the mgr pointer
363 * from of_fpga_mgr_get() or fpga_mgr_get() and checked that it is not an error
364 * code.
365 *
366 * Return: 0 on success, negative error code otherwise.
367 */
fpga_mgr_firmware_load(struct fpga_manager * mgr,struct fpga_image_info * info,const char * image_name)368 static int fpga_mgr_firmware_load(struct fpga_manager *mgr,
369 struct fpga_image_info *info,
370 const char *image_name)
371 {
372 struct device *dev = &mgr->dev;
373 const struct firmware *fw;
374 int ret;
375
376 dev_info(dev, "writing %s to %s\n", image_name, mgr->name);
377
378 mgr->state = FPGA_MGR_STATE_FIRMWARE_REQ;
379
380 ret = request_firmware(&fw, image_name, dev);
381 if (ret) {
382 mgr->state = FPGA_MGR_STATE_FIRMWARE_REQ_ERR;
383 dev_err(dev, "Error requesting firmware %s\n", image_name);
384 return ret;
385 }
386
387 ret = fpga_mgr_buf_load(mgr, info, fw->data, fw->size);
388
389 release_firmware(fw);
390
391 return ret;
392 }
393
394 /**
395 * fpga_mgr_load - load FPGA from scatter/gather table, buffer, or firmware
396 * @mgr: fpga manager
397 * @info: fpga image information.
398 *
399 * Load the FPGA from an image which is indicated in @info. If successful, the
400 * FPGA ends up in operating mode.
401 *
402 * Return: 0 on success, negative error code otherwise.
403 */
fpga_mgr_load(struct fpga_manager * mgr,struct fpga_image_info * info)404 int fpga_mgr_load(struct fpga_manager *mgr, struct fpga_image_info *info)
405 {
406 if (info->sgt)
407 return fpga_mgr_buf_load_sg(mgr, info, info->sgt);
408 if (info->buf && info->count)
409 return fpga_mgr_buf_load(mgr, info, info->buf, info->count);
410 if (info->firmware_name)
411 return fpga_mgr_firmware_load(mgr, info, info->firmware_name);
412 return -EINVAL;
413 }
414 EXPORT_SYMBOL_GPL(fpga_mgr_load);
415
416 static const char * const state_str[] = {
417 [FPGA_MGR_STATE_UNKNOWN] = "unknown",
418 [FPGA_MGR_STATE_POWER_OFF] = "power off",
419 [FPGA_MGR_STATE_POWER_UP] = "power up",
420 [FPGA_MGR_STATE_RESET] = "reset",
421
422 /* requesting FPGA image from firmware */
423 [FPGA_MGR_STATE_FIRMWARE_REQ] = "firmware request",
424 [FPGA_MGR_STATE_FIRMWARE_REQ_ERR] = "firmware request error",
425
426 /* Preparing FPGA to receive image */
427 [FPGA_MGR_STATE_WRITE_INIT] = "write init",
428 [FPGA_MGR_STATE_WRITE_INIT_ERR] = "write init error",
429
430 /* Writing image to FPGA */
431 [FPGA_MGR_STATE_WRITE] = "write",
432 [FPGA_MGR_STATE_WRITE_ERR] = "write error",
433
434 /* Finishing configuration after image has been written */
435 [FPGA_MGR_STATE_WRITE_COMPLETE] = "write complete",
436 [FPGA_MGR_STATE_WRITE_COMPLETE_ERR] = "write complete error",
437
438 /* FPGA reports to be in normal operating mode */
439 [FPGA_MGR_STATE_OPERATING] = "operating",
440 };
441
name_show(struct device * dev,struct device_attribute * attr,char * buf)442 static ssize_t name_show(struct device *dev,
443 struct device_attribute *attr, char *buf)
444 {
445 struct fpga_manager *mgr = to_fpga_manager(dev);
446
447 return sprintf(buf, "%s\n", mgr->name);
448 }
449
state_show(struct device * dev,struct device_attribute * attr,char * buf)450 static ssize_t state_show(struct device *dev,
451 struct device_attribute *attr, char *buf)
452 {
453 struct fpga_manager *mgr = to_fpga_manager(dev);
454
455 return sprintf(buf, "%s\n", state_str[mgr->state]);
456 }
457
status_show(struct device * dev,struct device_attribute * attr,char * buf)458 static ssize_t status_show(struct device *dev,
459 struct device_attribute *attr, char *buf)
460 {
461 struct fpga_manager *mgr = to_fpga_manager(dev);
462 u64 status;
463 int len = 0;
464
465 status = fpga_mgr_status(mgr);
466
467 if (status & FPGA_MGR_STATUS_OPERATION_ERR)
468 len += sprintf(buf + len, "reconfig operation error\n");
469 if (status & FPGA_MGR_STATUS_CRC_ERR)
470 len += sprintf(buf + len, "reconfig CRC error\n");
471 if (status & FPGA_MGR_STATUS_INCOMPATIBLE_IMAGE_ERR)
472 len += sprintf(buf + len, "reconfig incompatible image\n");
473 if (status & FPGA_MGR_STATUS_IP_PROTOCOL_ERR)
474 len += sprintf(buf + len, "reconfig IP protocol error\n");
475 if (status & FPGA_MGR_STATUS_FIFO_OVERFLOW_ERR)
476 len += sprintf(buf + len, "reconfig fifo overflow error\n");
477
478 return len;
479 }
480
481 static DEVICE_ATTR_RO(name);
482 static DEVICE_ATTR_RO(state);
483 static DEVICE_ATTR_RO(status);
484
485 static struct attribute *fpga_mgr_attrs[] = {
486 &dev_attr_name.attr,
487 &dev_attr_state.attr,
488 &dev_attr_status.attr,
489 NULL,
490 };
491 ATTRIBUTE_GROUPS(fpga_mgr);
492
__fpga_mgr_get(struct device * dev)493 static struct fpga_manager *__fpga_mgr_get(struct device *dev)
494 {
495 struct fpga_manager *mgr;
496
497 mgr = to_fpga_manager(dev);
498
499 if (!try_module_get(dev->parent->driver->owner))
500 goto err_dev;
501
502 return mgr;
503
504 err_dev:
505 put_device(dev);
506 return ERR_PTR(-ENODEV);
507 }
508
fpga_mgr_dev_match(struct device * dev,const void * data)509 static int fpga_mgr_dev_match(struct device *dev, const void *data)
510 {
511 return dev->parent == data;
512 }
513
514 /**
515 * fpga_mgr_get - Given a device, get a reference to an fpga mgr.
516 * @dev: parent device that fpga mgr was registered with
517 *
518 * Return: fpga manager struct or IS_ERR() condition containing error code.
519 */
fpga_mgr_get(struct device * dev)520 struct fpga_manager *fpga_mgr_get(struct device *dev)
521 {
522 struct device *mgr_dev = class_find_device(fpga_mgr_class, NULL, dev,
523 fpga_mgr_dev_match);
524 if (!mgr_dev)
525 return ERR_PTR(-ENODEV);
526
527 return __fpga_mgr_get(mgr_dev);
528 }
529 EXPORT_SYMBOL_GPL(fpga_mgr_get);
530
531 /**
532 * of_fpga_mgr_get - Given a device node, get a reference to an fpga mgr.
533 *
534 * @node: device node
535 *
536 * Return: fpga manager struct or IS_ERR() condition containing error code.
537 */
of_fpga_mgr_get(struct device_node * node)538 struct fpga_manager *of_fpga_mgr_get(struct device_node *node)
539 {
540 struct device *dev;
541
542 dev = class_find_device_by_of_node(fpga_mgr_class, node);
543 if (!dev)
544 return ERR_PTR(-ENODEV);
545
546 return __fpga_mgr_get(dev);
547 }
548 EXPORT_SYMBOL_GPL(of_fpga_mgr_get);
549
550 /**
551 * fpga_mgr_put - release a reference to an fpga manager
552 * @mgr: fpga manager structure
553 */
fpga_mgr_put(struct fpga_manager * mgr)554 void fpga_mgr_put(struct fpga_manager *mgr)
555 {
556 module_put(mgr->dev.parent->driver->owner);
557 put_device(&mgr->dev);
558 }
559 EXPORT_SYMBOL_GPL(fpga_mgr_put);
560
561 /**
562 * fpga_mgr_lock - Lock FPGA manager for exclusive use
563 * @mgr: fpga manager
564 *
565 * Given a pointer to FPGA Manager (from fpga_mgr_get() or
566 * of_fpga_mgr_put()) attempt to get the mutex. The user should call
567 * fpga_mgr_lock() and verify that it returns 0 before attempting to
568 * program the FPGA. Likewise, the user should call fpga_mgr_unlock
569 * when done programming the FPGA.
570 *
571 * Return: 0 for success or -EBUSY
572 */
fpga_mgr_lock(struct fpga_manager * mgr)573 int fpga_mgr_lock(struct fpga_manager *mgr)
574 {
575 if (!mutex_trylock(&mgr->ref_mutex)) {
576 dev_err(&mgr->dev, "FPGA manager is in use.\n");
577 return -EBUSY;
578 }
579
580 return 0;
581 }
582 EXPORT_SYMBOL_GPL(fpga_mgr_lock);
583
584 /**
585 * fpga_mgr_unlock - Unlock FPGA manager after done programming
586 * @mgr: fpga manager
587 */
fpga_mgr_unlock(struct fpga_manager * mgr)588 void fpga_mgr_unlock(struct fpga_manager *mgr)
589 {
590 mutex_unlock(&mgr->ref_mutex);
591 }
592 EXPORT_SYMBOL_GPL(fpga_mgr_unlock);
593
594 /**
595 * fpga_mgr_create - create and initialize an FPGA manager struct
596 * @parent: fpga manager device from pdev
597 * @name: fpga manager name
598 * @mops: pointer to structure of fpga manager ops
599 * @priv: fpga manager private data
600 *
601 * The caller of this function is responsible for freeing the struct with
602 * fpga_mgr_free(). Using devm_fpga_mgr_create() instead is recommended.
603 *
604 * Return: pointer to struct fpga_manager or NULL
605 */
fpga_mgr_create(struct device * parent,const char * name,const struct fpga_manager_ops * mops,void * priv)606 struct fpga_manager *fpga_mgr_create(struct device *parent, const char *name,
607 const struct fpga_manager_ops *mops,
608 void *priv)
609 {
610 struct fpga_manager *mgr;
611 int id, ret;
612
613 if (!mops) {
614 dev_err(parent, "Attempt to register without fpga_manager_ops\n");
615 return NULL;
616 }
617
618 if (!name || !strlen(name)) {
619 dev_err(parent, "Attempt to register with no name!\n");
620 return NULL;
621 }
622
623 mgr = kzalloc(sizeof(*mgr), GFP_KERNEL);
624 if (!mgr)
625 return NULL;
626
627 id = ida_simple_get(&fpga_mgr_ida, 0, 0, GFP_KERNEL);
628 if (id < 0)
629 goto error_kfree;
630
631 mutex_init(&mgr->ref_mutex);
632
633 mgr->name = name;
634 mgr->mops = mops;
635 mgr->priv = priv;
636
637 device_initialize(&mgr->dev);
638 mgr->dev.class = fpga_mgr_class;
639 mgr->dev.groups = mops->groups;
640 mgr->dev.parent = parent;
641 mgr->dev.of_node = parent->of_node;
642 mgr->dev.id = id;
643
644 ret = dev_set_name(&mgr->dev, "fpga%d", id);
645 if (ret)
646 goto error_device;
647
648 return mgr;
649
650 error_device:
651 ida_simple_remove(&fpga_mgr_ida, id);
652 error_kfree:
653 kfree(mgr);
654
655 return NULL;
656 }
657 EXPORT_SYMBOL_GPL(fpga_mgr_create);
658
659 /**
660 * fpga_mgr_free - free an FPGA manager created with fpga_mgr_create()
661 * @mgr: fpga manager struct
662 */
fpga_mgr_free(struct fpga_manager * mgr)663 void fpga_mgr_free(struct fpga_manager *mgr)
664 {
665 ida_simple_remove(&fpga_mgr_ida, mgr->dev.id);
666 kfree(mgr);
667 }
668 EXPORT_SYMBOL_GPL(fpga_mgr_free);
669
devm_fpga_mgr_release(struct device * dev,void * res)670 static void devm_fpga_mgr_release(struct device *dev, void *res)
671 {
672 struct fpga_mgr_devres *dr = res;
673
674 fpga_mgr_free(dr->mgr);
675 }
676
677 /**
678 * devm_fpga_mgr_create - create and initialize a managed FPGA manager struct
679 * @parent: fpga manager device from pdev
680 * @name: fpga manager name
681 * @mops: pointer to structure of fpga manager ops
682 * @priv: fpga manager private data
683 *
684 * This function is intended for use in an FPGA manager driver's probe function.
685 * After the manager driver creates the manager struct with
686 * devm_fpga_mgr_create(), it should register it with fpga_mgr_register(). The
687 * manager driver's remove function should call fpga_mgr_unregister(). The
688 * manager struct allocated with this function will be freed automatically on
689 * driver detach. This includes the case of a probe function returning error
690 * before calling fpga_mgr_register(), the struct will still get cleaned up.
691 *
692 * Return: pointer to struct fpga_manager or NULL
693 */
devm_fpga_mgr_create(struct device * parent,const char * name,const struct fpga_manager_ops * mops,void * priv)694 struct fpga_manager *devm_fpga_mgr_create(struct device *parent, const char *name,
695 const struct fpga_manager_ops *mops,
696 void *priv)
697 {
698 struct fpga_mgr_devres *dr;
699
700 dr = devres_alloc(devm_fpga_mgr_release, sizeof(*dr), GFP_KERNEL);
701 if (!dr)
702 return NULL;
703
704 dr->mgr = fpga_mgr_create(parent, name, mops, priv);
705 if (!dr->mgr) {
706 devres_free(dr);
707 return NULL;
708 }
709
710 devres_add(parent, dr);
711
712 return dr->mgr;
713 }
714 EXPORT_SYMBOL_GPL(devm_fpga_mgr_create);
715
716 /**
717 * fpga_mgr_register - register an FPGA manager
718 * @mgr: fpga manager struct
719 *
720 * Return: 0 on success, negative error code otherwise.
721 */
fpga_mgr_register(struct fpga_manager * mgr)722 int fpga_mgr_register(struct fpga_manager *mgr)
723 {
724 int ret;
725
726 /*
727 * Initialize framework state by requesting low level driver read state
728 * from device. FPGA may be in reset mode or may have been programmed
729 * by bootloader or EEPROM.
730 */
731 mgr->state = fpga_mgr_state(mgr);
732
733 ret = device_add(&mgr->dev);
734 if (ret)
735 goto error_device;
736
737 dev_info(&mgr->dev, "%s registered\n", mgr->name);
738
739 return 0;
740
741 error_device:
742 ida_simple_remove(&fpga_mgr_ida, mgr->dev.id);
743
744 return ret;
745 }
746 EXPORT_SYMBOL_GPL(fpga_mgr_register);
747
748 /**
749 * fpga_mgr_unregister - unregister an FPGA manager
750 * @mgr: fpga manager struct
751 *
752 * This function is intended for use in an FPGA manager driver's remove function.
753 */
fpga_mgr_unregister(struct fpga_manager * mgr)754 void fpga_mgr_unregister(struct fpga_manager *mgr)
755 {
756 dev_info(&mgr->dev, "%s %s\n", __func__, mgr->name);
757
758 /*
759 * If the low level driver provides a method for putting fpga into
760 * a desired state upon unregister, do it.
761 */
762 fpga_mgr_fpga_remove(mgr);
763
764 device_unregister(&mgr->dev);
765 }
766 EXPORT_SYMBOL_GPL(fpga_mgr_unregister);
767
fpga_mgr_devres_match(struct device * dev,void * res,void * match_data)768 static int fpga_mgr_devres_match(struct device *dev, void *res,
769 void *match_data)
770 {
771 struct fpga_mgr_devres *dr = res;
772
773 return match_data == dr->mgr;
774 }
775
devm_fpga_mgr_unregister(struct device * dev,void * res)776 static void devm_fpga_mgr_unregister(struct device *dev, void *res)
777 {
778 struct fpga_mgr_devres *dr = res;
779
780 fpga_mgr_unregister(dr->mgr);
781 }
782
783 /**
784 * devm_fpga_mgr_register - resource managed variant of fpga_mgr_register()
785 * @dev: managing device for this FPGA manager
786 * @mgr: fpga manager struct
787 *
788 * This is the devres variant of fpga_mgr_register() for which the unregister
789 * function will be called automatically when the managing device is detached.
790 */
devm_fpga_mgr_register(struct device * dev,struct fpga_manager * mgr)791 int devm_fpga_mgr_register(struct device *dev, struct fpga_manager *mgr)
792 {
793 struct fpga_mgr_devres *dr;
794 int ret;
795
796 /*
797 * Make sure that the struct fpga_manager * that is passed in is
798 * managed itself.
799 */
800 if (WARN_ON(!devres_find(dev, devm_fpga_mgr_release,
801 fpga_mgr_devres_match, mgr)))
802 return -EINVAL;
803
804 dr = devres_alloc(devm_fpga_mgr_unregister, sizeof(*dr), GFP_KERNEL);
805 if (!dr)
806 return -ENOMEM;
807
808 ret = fpga_mgr_register(mgr);
809 if (ret) {
810 devres_free(dr);
811 return ret;
812 }
813
814 dr->mgr = mgr;
815 devres_add(dev, dr);
816
817 return 0;
818 }
819 EXPORT_SYMBOL_GPL(devm_fpga_mgr_register);
820
fpga_mgr_dev_release(struct device * dev)821 static void fpga_mgr_dev_release(struct device *dev)
822 {
823 }
824
fpga_mgr_class_init(void)825 static int __init fpga_mgr_class_init(void)
826 {
827 pr_info("FPGA manager framework\n");
828
829 fpga_mgr_class = class_create(THIS_MODULE, "fpga_manager");
830 if (IS_ERR(fpga_mgr_class))
831 return PTR_ERR(fpga_mgr_class);
832
833 fpga_mgr_class->dev_groups = fpga_mgr_groups;
834 fpga_mgr_class->dev_release = fpga_mgr_dev_release;
835
836 return 0;
837 }
838
fpga_mgr_class_exit(void)839 static void __exit fpga_mgr_class_exit(void)
840 {
841 class_destroy(fpga_mgr_class);
842 ida_destroy(&fpga_mgr_ida);
843 }
844
845 MODULE_AUTHOR("Alan Tull <atull@kernel.org>");
846 MODULE_DESCRIPTION("FPGA manager framework");
847 MODULE_LICENSE("GPL v2");
848
849 subsys_initcall(fpga_mgr_class_init);
850 module_exit(fpga_mgr_class_exit);
851