xref: /openbmc/linux/drivers/fpga/fpga-mgr.c (revision 2da62a13)
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 const 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_parse_header(struct fpga_manager * mgr,struct fpga_image_info * info,const char * buf,size_t count)77 static inline int fpga_mgr_parse_header(struct fpga_manager *mgr,
78 					struct fpga_image_info *info,
79 					const char *buf, size_t count)
80 {
81 	if (mgr->mops->parse_header)
82 		return mgr->mops->parse_header(mgr, info, buf, count);
83 	return 0;
84 }
85 
fpga_mgr_write_init(struct fpga_manager * mgr,struct fpga_image_info * info,const char * buf,size_t count)86 static inline int fpga_mgr_write_init(struct fpga_manager *mgr,
87 				      struct fpga_image_info *info,
88 				      const char *buf, size_t count)
89 {
90 	if (mgr->mops->write_init)
91 		return  mgr->mops->write_init(mgr, info, buf, count);
92 	return 0;
93 }
94 
fpga_mgr_write_sg(struct fpga_manager * mgr,struct sg_table * sgt)95 static inline int fpga_mgr_write_sg(struct fpga_manager *mgr,
96 				    struct sg_table *sgt)
97 {
98 	if (mgr->mops->write_sg)
99 		return  mgr->mops->write_sg(mgr, sgt);
100 	return -EOPNOTSUPP;
101 }
102 
103 /**
104  * fpga_image_info_alloc - Allocate an FPGA image info struct
105  * @dev: owning device
106  *
107  * Return: struct fpga_image_info or NULL
108  */
fpga_image_info_alloc(struct device * dev)109 struct fpga_image_info *fpga_image_info_alloc(struct device *dev)
110 {
111 	struct fpga_image_info *info;
112 
113 	get_device(dev);
114 
115 	info = devm_kzalloc(dev, sizeof(*info), GFP_KERNEL);
116 	if (!info) {
117 		put_device(dev);
118 		return NULL;
119 	}
120 
121 	info->dev = dev;
122 
123 	return info;
124 }
125 EXPORT_SYMBOL_GPL(fpga_image_info_alloc);
126 
127 /**
128  * fpga_image_info_free - Free an FPGA image info struct
129  * @info: FPGA image info struct to free
130  */
fpga_image_info_free(struct fpga_image_info * info)131 void fpga_image_info_free(struct fpga_image_info *info)
132 {
133 	struct device *dev;
134 
135 	if (!info)
136 		return;
137 
138 	dev = info->dev;
139 	if (info->firmware_name)
140 		devm_kfree(dev, info->firmware_name);
141 
142 	devm_kfree(dev, info);
143 	put_device(dev);
144 }
145 EXPORT_SYMBOL_GPL(fpga_image_info_free);
146 
147 /*
148  * Call the low level driver's parse_header function with entire FPGA image
149  * buffer on the input. This will set info->header_size and info->data_size.
150  */
fpga_mgr_parse_header_mapped(struct fpga_manager * mgr,struct fpga_image_info * info,const char * buf,size_t count)151 static int fpga_mgr_parse_header_mapped(struct fpga_manager *mgr,
152 					struct fpga_image_info *info,
153 					const char *buf, size_t count)
154 {
155 	int ret;
156 
157 	mgr->state = FPGA_MGR_STATE_PARSE_HEADER;
158 	ret = fpga_mgr_parse_header(mgr, info, buf, count);
159 
160 	if (info->header_size + info->data_size > count) {
161 		dev_err(&mgr->dev, "Bitstream data outruns FPGA image\n");
162 		ret = -EINVAL;
163 	}
164 
165 	if (ret) {
166 		dev_err(&mgr->dev, "Error while parsing FPGA image header\n");
167 		mgr->state = FPGA_MGR_STATE_PARSE_HEADER_ERR;
168 	}
169 
170 	return ret;
171 }
172 
173 /*
174  * Call the low level driver's parse_header function with first fragment of
175  * scattered FPGA image on the input. If header fits first fragment,
176  * parse_header will set info->header_size and info->data_size. If it is not,
177  * parse_header will set desired size to info->header_size and -EAGAIN will be
178  * returned.
179  */
fpga_mgr_parse_header_sg_first(struct fpga_manager * mgr,struct fpga_image_info * info,struct sg_table * sgt)180 static int fpga_mgr_parse_header_sg_first(struct fpga_manager *mgr,
181 					  struct fpga_image_info *info,
182 					  struct sg_table *sgt)
183 {
184 	struct sg_mapping_iter miter;
185 	int ret;
186 
187 	mgr->state = FPGA_MGR_STATE_PARSE_HEADER;
188 
189 	sg_miter_start(&miter, sgt->sgl, sgt->nents, SG_MITER_FROM_SG);
190 	if (sg_miter_next(&miter) &&
191 	    miter.length >= info->header_size)
192 		ret = fpga_mgr_parse_header(mgr, info, miter.addr, miter.length);
193 	else
194 		ret = -EAGAIN;
195 	sg_miter_stop(&miter);
196 
197 	if (ret && ret != -EAGAIN) {
198 		dev_err(&mgr->dev, "Error while parsing FPGA image header\n");
199 		mgr->state = FPGA_MGR_STATE_PARSE_HEADER_ERR;
200 	}
201 
202 	return ret;
203 }
204 
205 /*
206  * Copy scattered FPGA image fragments to temporary buffer and call the
207  * low level driver's parse_header function. This should be called after
208  * fpga_mgr_parse_header_sg_first() returned -EAGAIN. In case of success,
209  * pointer to the newly allocated image header copy will be returned and
210  * its size will be set into *ret_size. Returned buffer needs to be freed.
211  */
fpga_mgr_parse_header_sg(struct fpga_manager * mgr,struct fpga_image_info * info,struct sg_table * sgt,size_t * ret_size)212 static void *fpga_mgr_parse_header_sg(struct fpga_manager *mgr,
213 				      struct fpga_image_info *info,
214 				      struct sg_table *sgt, size_t *ret_size)
215 {
216 	size_t len, new_header_size, header_size = 0;
217 	char *new_buf, *buf = NULL;
218 	int ret;
219 
220 	do {
221 		new_header_size = info->header_size;
222 		if (new_header_size <= header_size) {
223 			dev_err(&mgr->dev, "Requested invalid header size\n");
224 			ret = -EFAULT;
225 			break;
226 		}
227 
228 		new_buf = krealloc(buf, new_header_size, GFP_KERNEL);
229 		if (!new_buf) {
230 			ret = -ENOMEM;
231 			break;
232 		}
233 
234 		buf = new_buf;
235 
236 		len = sg_pcopy_to_buffer(sgt->sgl, sgt->nents,
237 					 buf + header_size,
238 					 new_header_size - header_size,
239 					 header_size);
240 		if (len != new_header_size - header_size) {
241 			ret = -EFAULT;
242 			break;
243 		}
244 
245 		header_size = new_header_size;
246 		ret = fpga_mgr_parse_header(mgr, info, buf, header_size);
247 	} while (ret == -EAGAIN);
248 
249 	if (ret) {
250 		dev_err(&mgr->dev, "Error while parsing FPGA image header\n");
251 		mgr->state = FPGA_MGR_STATE_PARSE_HEADER_ERR;
252 		kfree(buf);
253 		buf = ERR_PTR(ret);
254 	}
255 
256 	*ret_size = header_size;
257 
258 	return buf;
259 }
260 
261 /*
262  * Call the low level driver's write_init function. This will do the
263  * device-specific things to get the FPGA into the state where it is ready to
264  * receive an FPGA image. The low level driver gets to see at least first
265  * info->header_size bytes in the buffer. If info->header_size is 0,
266  * write_init will not get any bytes of image buffer.
267  */
fpga_mgr_write_init_buf(struct fpga_manager * mgr,struct fpga_image_info * info,const char * buf,size_t count)268 static int fpga_mgr_write_init_buf(struct fpga_manager *mgr,
269 				   struct fpga_image_info *info,
270 				   const char *buf, size_t count)
271 {
272 	size_t header_size = info->header_size;
273 	int ret;
274 
275 	mgr->state = FPGA_MGR_STATE_WRITE_INIT;
276 
277 	if (header_size > count)
278 		ret = -EINVAL;
279 	else if (!header_size)
280 		ret = fpga_mgr_write_init(mgr, info, NULL, 0);
281 	else
282 		ret = fpga_mgr_write_init(mgr, info, buf, count);
283 
284 	if (ret) {
285 		dev_err(&mgr->dev, "Error preparing FPGA for writing\n");
286 		mgr->state = FPGA_MGR_STATE_WRITE_INIT_ERR;
287 		return ret;
288 	}
289 
290 	return 0;
291 }
292 
fpga_mgr_prepare_sg(struct fpga_manager * mgr,struct fpga_image_info * info,struct sg_table * sgt)293 static int fpga_mgr_prepare_sg(struct fpga_manager *mgr,
294 			       struct fpga_image_info *info,
295 			       struct sg_table *sgt)
296 {
297 	struct sg_mapping_iter miter;
298 	size_t len;
299 	char *buf;
300 	int ret;
301 
302 	/* Short path. Low level driver don't care about image header. */
303 	if (!mgr->mops->initial_header_size && !mgr->mops->parse_header)
304 		return fpga_mgr_write_init_buf(mgr, info, NULL, 0);
305 
306 	/*
307 	 * First try to use miter to map the first fragment to access the
308 	 * header, this is the typical path.
309 	 */
310 	ret = fpga_mgr_parse_header_sg_first(mgr, info, sgt);
311 	/* If 0, header fits first fragment, call write_init on it */
312 	if (!ret) {
313 		sg_miter_start(&miter, sgt->sgl, sgt->nents, SG_MITER_FROM_SG);
314 		if (sg_miter_next(&miter)) {
315 			ret = fpga_mgr_write_init_buf(mgr, info, miter.addr,
316 						      miter.length);
317 			sg_miter_stop(&miter);
318 			return ret;
319 		}
320 		sg_miter_stop(&miter);
321 	/*
322 	 * If -EAGAIN, more sg buffer is needed,
323 	 * otherwise an error has occurred.
324 	 */
325 	} else if (ret != -EAGAIN) {
326 		return ret;
327 	}
328 
329 	/*
330 	 * Copy the fragments into temporary memory.
331 	 * Copying is done inside fpga_mgr_parse_header_sg().
332 	 */
333 	buf = fpga_mgr_parse_header_sg(mgr, info, sgt, &len);
334 	if (IS_ERR(buf))
335 		return PTR_ERR(buf);
336 
337 	ret = fpga_mgr_write_init_buf(mgr, info, buf, len);
338 
339 	kfree(buf);
340 
341 	return ret;
342 }
343 
344 /**
345  * fpga_mgr_buf_load_sg - load fpga from image in buffer from a scatter list
346  * @mgr:	fpga manager
347  * @info:	fpga image specific information
348  * @sgt:	scatterlist table
349  *
350  * Step the low level fpga manager through the device-specific steps of getting
351  * an FPGA ready to be configured, writing the image to it, then doing whatever
352  * post-configuration steps necessary.  This code assumes the caller got the
353  * mgr pointer from of_fpga_mgr_get() or fpga_mgr_get() and checked that it is
354  * not an error code.
355  *
356  * This is the preferred entry point for FPGA programming, it does not require
357  * any contiguous kernel memory.
358  *
359  * Return: 0 on success, negative error code otherwise.
360  */
fpga_mgr_buf_load_sg(struct fpga_manager * mgr,struct fpga_image_info * info,struct sg_table * sgt)361 static int fpga_mgr_buf_load_sg(struct fpga_manager *mgr,
362 				struct fpga_image_info *info,
363 				struct sg_table *sgt)
364 {
365 	int ret;
366 
367 	ret = fpga_mgr_prepare_sg(mgr, info, sgt);
368 	if (ret)
369 		return ret;
370 
371 	/* Write the FPGA image to the FPGA. */
372 	mgr->state = FPGA_MGR_STATE_WRITE;
373 	if (mgr->mops->write_sg) {
374 		ret = fpga_mgr_write_sg(mgr, sgt);
375 	} else {
376 		size_t length, count = 0, data_size = info->data_size;
377 		struct sg_mapping_iter miter;
378 
379 		sg_miter_start(&miter, sgt->sgl, sgt->nents, SG_MITER_FROM_SG);
380 
381 		if (mgr->mops->skip_header &&
382 		    !sg_miter_skip(&miter, info->header_size)) {
383 			ret = -EINVAL;
384 			goto out;
385 		}
386 
387 		while (sg_miter_next(&miter)) {
388 			if (data_size)
389 				length = min(miter.length, data_size - count);
390 			else
391 				length = miter.length;
392 
393 			ret = fpga_mgr_write(mgr, miter.addr, length);
394 			if (ret)
395 				break;
396 
397 			count += length;
398 			if (data_size && count >= data_size)
399 				break;
400 		}
401 		sg_miter_stop(&miter);
402 	}
403 
404 out:
405 	if (ret) {
406 		dev_err(&mgr->dev, "Error while writing image data to FPGA\n");
407 		mgr->state = FPGA_MGR_STATE_WRITE_ERR;
408 		return ret;
409 	}
410 
411 	return fpga_mgr_write_complete(mgr, info);
412 }
413 
fpga_mgr_buf_load_mapped(struct fpga_manager * mgr,struct fpga_image_info * info,const char * buf,size_t count)414 static int fpga_mgr_buf_load_mapped(struct fpga_manager *mgr,
415 				    struct fpga_image_info *info,
416 				    const char *buf, size_t count)
417 {
418 	int ret;
419 
420 	ret = fpga_mgr_parse_header_mapped(mgr, info, buf, count);
421 	if (ret)
422 		return ret;
423 
424 	ret = fpga_mgr_write_init_buf(mgr, info, buf, count);
425 	if (ret)
426 		return ret;
427 
428 	if (mgr->mops->skip_header) {
429 		buf += info->header_size;
430 		count -= info->header_size;
431 	}
432 
433 	if (info->data_size)
434 		count = info->data_size;
435 
436 	/*
437 	 * Write the FPGA image to the FPGA.
438 	 */
439 	mgr->state = FPGA_MGR_STATE_WRITE;
440 	ret = fpga_mgr_write(mgr, buf, count);
441 	if (ret) {
442 		dev_err(&mgr->dev, "Error while writing image data to FPGA\n");
443 		mgr->state = FPGA_MGR_STATE_WRITE_ERR;
444 		return ret;
445 	}
446 
447 	return fpga_mgr_write_complete(mgr, info);
448 }
449 
450 /**
451  * fpga_mgr_buf_load - load fpga from image in buffer
452  * @mgr:	fpga manager
453  * @info:	fpga image info
454  * @buf:	buffer contain fpga image
455  * @count:	byte count of buf
456  *
457  * Step the low level fpga manager through the device-specific steps of getting
458  * an FPGA ready to be configured, writing the image to it, then doing whatever
459  * post-configuration steps necessary.  This code assumes the caller got the
460  * mgr pointer from of_fpga_mgr_get() and checked that it is not an error code.
461  *
462  * Return: 0 on success, negative error code otherwise.
463  */
fpga_mgr_buf_load(struct fpga_manager * mgr,struct fpga_image_info * info,const char * buf,size_t count)464 static int fpga_mgr_buf_load(struct fpga_manager *mgr,
465 			     struct fpga_image_info *info,
466 			     const char *buf, size_t count)
467 {
468 	struct page **pages;
469 	struct sg_table sgt;
470 	const void *p;
471 	int nr_pages;
472 	int index;
473 	int rc;
474 
475 	/*
476 	 * This is just a fast path if the caller has already created a
477 	 * contiguous kernel buffer and the driver doesn't require SG, non-SG
478 	 * drivers will still work on the slow path.
479 	 */
480 	if (mgr->mops->write)
481 		return fpga_mgr_buf_load_mapped(mgr, info, buf, count);
482 
483 	/*
484 	 * Convert the linear kernel pointer into a sg_table of pages for use
485 	 * by the driver.
486 	 */
487 	nr_pages = DIV_ROUND_UP((unsigned long)buf + count, PAGE_SIZE) -
488 		   (unsigned long)buf / PAGE_SIZE;
489 	pages = kmalloc_array(nr_pages, sizeof(struct page *), GFP_KERNEL);
490 	if (!pages)
491 		return -ENOMEM;
492 
493 	p = buf - offset_in_page(buf);
494 	for (index = 0; index < nr_pages; index++) {
495 		if (is_vmalloc_addr(p))
496 			pages[index] = vmalloc_to_page(p);
497 		else
498 			pages[index] = kmap_to_page((void *)p);
499 		if (!pages[index]) {
500 			kfree(pages);
501 			return -EFAULT;
502 		}
503 		p += PAGE_SIZE;
504 	}
505 
506 	/*
507 	 * The temporary pages list is used to code share the merging algorithm
508 	 * in sg_alloc_table_from_pages
509 	 */
510 	rc = sg_alloc_table_from_pages(&sgt, pages, index, offset_in_page(buf),
511 				       count, GFP_KERNEL);
512 	kfree(pages);
513 	if (rc)
514 		return rc;
515 
516 	rc = fpga_mgr_buf_load_sg(mgr, info, &sgt);
517 	sg_free_table(&sgt);
518 
519 	return rc;
520 }
521 
522 /**
523  * fpga_mgr_firmware_load - request firmware and load to fpga
524  * @mgr:	fpga manager
525  * @info:	fpga image specific information
526  * @image_name:	name of image file on the firmware search path
527  *
528  * Request an FPGA image using the firmware class, then write out to the FPGA.
529  * Update the state before each step to provide info on what step failed if
530  * there is a failure.  This code assumes the caller got the mgr pointer
531  * from of_fpga_mgr_get() or fpga_mgr_get() and checked that it is not an error
532  * code.
533  *
534  * Return: 0 on success, negative error code otherwise.
535  */
fpga_mgr_firmware_load(struct fpga_manager * mgr,struct fpga_image_info * info,const char * image_name)536 static int fpga_mgr_firmware_load(struct fpga_manager *mgr,
537 				  struct fpga_image_info *info,
538 				  const char *image_name)
539 {
540 	struct device *dev = &mgr->dev;
541 	const struct firmware *fw;
542 	int ret;
543 
544 	dev_info(dev, "writing %s to %s\n", image_name, mgr->name);
545 
546 	mgr->state = FPGA_MGR_STATE_FIRMWARE_REQ;
547 
548 	ret = request_firmware(&fw, image_name, dev);
549 	if (ret) {
550 		mgr->state = FPGA_MGR_STATE_FIRMWARE_REQ_ERR;
551 		dev_err(dev, "Error requesting firmware %s\n", image_name);
552 		return ret;
553 	}
554 
555 	ret = fpga_mgr_buf_load(mgr, info, fw->data, fw->size);
556 
557 	release_firmware(fw);
558 
559 	return ret;
560 }
561 
562 /**
563  * fpga_mgr_load - load FPGA from scatter/gather table, buffer, or firmware
564  * @mgr:	fpga manager
565  * @info:	fpga image information.
566  *
567  * Load the FPGA from an image which is indicated in @info.  If successful, the
568  * FPGA ends up in operating mode.
569  *
570  * Return: 0 on success, negative error code otherwise.
571  */
fpga_mgr_load(struct fpga_manager * mgr,struct fpga_image_info * info)572 int fpga_mgr_load(struct fpga_manager *mgr, struct fpga_image_info *info)
573 {
574 	info->header_size = mgr->mops->initial_header_size;
575 
576 	if (info->sgt)
577 		return fpga_mgr_buf_load_sg(mgr, info, info->sgt);
578 	if (info->buf && info->count)
579 		return fpga_mgr_buf_load(mgr, info, info->buf, info->count);
580 	if (info->firmware_name)
581 		return fpga_mgr_firmware_load(mgr, info, info->firmware_name);
582 	return -EINVAL;
583 }
584 EXPORT_SYMBOL_GPL(fpga_mgr_load);
585 
586 static const char * const state_str[] = {
587 	[FPGA_MGR_STATE_UNKNOWN] =		"unknown",
588 	[FPGA_MGR_STATE_POWER_OFF] =		"power off",
589 	[FPGA_MGR_STATE_POWER_UP] =		"power up",
590 	[FPGA_MGR_STATE_RESET] =		"reset",
591 
592 	/* requesting FPGA image from firmware */
593 	[FPGA_MGR_STATE_FIRMWARE_REQ] =		"firmware request",
594 	[FPGA_MGR_STATE_FIRMWARE_REQ_ERR] =	"firmware request error",
595 
596 	/* Parse FPGA image header */
597 	[FPGA_MGR_STATE_PARSE_HEADER] =		"parse header",
598 	[FPGA_MGR_STATE_PARSE_HEADER_ERR] =	"parse header error",
599 
600 	/* Preparing FPGA to receive image */
601 	[FPGA_MGR_STATE_WRITE_INIT] =		"write init",
602 	[FPGA_MGR_STATE_WRITE_INIT_ERR] =	"write init error",
603 
604 	/* Writing image to FPGA */
605 	[FPGA_MGR_STATE_WRITE] =		"write",
606 	[FPGA_MGR_STATE_WRITE_ERR] =		"write error",
607 
608 	/* Finishing configuration after image has been written */
609 	[FPGA_MGR_STATE_WRITE_COMPLETE] =	"write complete",
610 	[FPGA_MGR_STATE_WRITE_COMPLETE_ERR] =	"write complete error",
611 
612 	/* FPGA reports to be in normal operating mode */
613 	[FPGA_MGR_STATE_OPERATING] =		"operating",
614 };
615 
name_show(struct device * dev,struct device_attribute * attr,char * buf)616 static ssize_t name_show(struct device *dev,
617 			 struct device_attribute *attr, char *buf)
618 {
619 	struct fpga_manager *mgr = to_fpga_manager(dev);
620 
621 	return sprintf(buf, "%s\n", mgr->name);
622 }
623 
state_show(struct device * dev,struct device_attribute * attr,char * buf)624 static ssize_t state_show(struct device *dev,
625 			  struct device_attribute *attr, char *buf)
626 {
627 	struct fpga_manager *mgr = to_fpga_manager(dev);
628 
629 	return sprintf(buf, "%s\n", state_str[mgr->state]);
630 }
631 
status_show(struct device * dev,struct device_attribute * attr,char * buf)632 static ssize_t status_show(struct device *dev,
633 			   struct device_attribute *attr, char *buf)
634 {
635 	struct fpga_manager *mgr = to_fpga_manager(dev);
636 	u64 status;
637 	int len = 0;
638 
639 	status = fpga_mgr_status(mgr);
640 
641 	if (status & FPGA_MGR_STATUS_OPERATION_ERR)
642 		len += sprintf(buf + len, "reconfig operation error\n");
643 	if (status & FPGA_MGR_STATUS_CRC_ERR)
644 		len += sprintf(buf + len, "reconfig CRC error\n");
645 	if (status & FPGA_MGR_STATUS_INCOMPATIBLE_IMAGE_ERR)
646 		len += sprintf(buf + len, "reconfig incompatible image\n");
647 	if (status & FPGA_MGR_STATUS_IP_PROTOCOL_ERR)
648 		len += sprintf(buf + len, "reconfig IP protocol error\n");
649 	if (status & FPGA_MGR_STATUS_FIFO_OVERFLOW_ERR)
650 		len += sprintf(buf + len, "reconfig fifo overflow error\n");
651 
652 	return len;
653 }
654 
655 static DEVICE_ATTR_RO(name);
656 static DEVICE_ATTR_RO(state);
657 static DEVICE_ATTR_RO(status);
658 
659 static struct attribute *fpga_mgr_attrs[] = {
660 	&dev_attr_name.attr,
661 	&dev_attr_state.attr,
662 	&dev_attr_status.attr,
663 	NULL,
664 };
665 ATTRIBUTE_GROUPS(fpga_mgr);
666 
__fpga_mgr_get(struct device * mgr_dev)667 static struct fpga_manager *__fpga_mgr_get(struct device *mgr_dev)
668 {
669 	struct fpga_manager *mgr;
670 
671 	mgr = to_fpga_manager(mgr_dev);
672 
673 	if (!try_module_get(mgr->mops_owner))
674 		mgr = ERR_PTR(-ENODEV);
675 
676 	return mgr;
677 }
678 
fpga_mgr_dev_match(struct device * dev,const void * data)679 static int fpga_mgr_dev_match(struct device *dev, const void *data)
680 {
681 	return dev->parent == data;
682 }
683 
684 /**
685  * fpga_mgr_get - Given a device, get a reference to an fpga mgr.
686  * @dev:	parent device that fpga mgr was registered with
687  *
688  * Return: fpga manager struct or IS_ERR() condition containing error code.
689  */
fpga_mgr_get(struct device * dev)690 struct fpga_manager *fpga_mgr_get(struct device *dev)
691 {
692 	struct fpga_manager *mgr;
693 	struct device *mgr_dev;
694 
695 	mgr_dev = class_find_device(&fpga_mgr_class, NULL, dev, fpga_mgr_dev_match);
696 	if (!mgr_dev)
697 		return ERR_PTR(-ENODEV);
698 
699 	mgr = __fpga_mgr_get(mgr_dev);
700 	if (IS_ERR(mgr))
701 		put_device(mgr_dev);
702 
703 	return mgr;
704 }
705 EXPORT_SYMBOL_GPL(fpga_mgr_get);
706 
707 /**
708  * of_fpga_mgr_get - Given a device node, get a reference to an fpga mgr.
709  *
710  * @node:	device node
711  *
712  * Return: fpga manager struct or IS_ERR() condition containing error code.
713  */
of_fpga_mgr_get(struct device_node * node)714 struct fpga_manager *of_fpga_mgr_get(struct device_node *node)
715 {
716 	struct fpga_manager *mgr;
717 	struct device *mgr_dev;
718 
719 	mgr_dev = class_find_device_by_of_node(&fpga_mgr_class, node);
720 	if (!mgr_dev)
721 		return ERR_PTR(-ENODEV);
722 
723 	mgr = __fpga_mgr_get(mgr_dev);
724 	if (IS_ERR(mgr))
725 		put_device(mgr_dev);
726 
727 	return mgr;
728 }
729 EXPORT_SYMBOL_GPL(of_fpga_mgr_get);
730 
731 /**
732  * fpga_mgr_put - release a reference to an fpga manager
733  * @mgr:	fpga manager structure
734  */
fpga_mgr_put(struct fpga_manager * mgr)735 void fpga_mgr_put(struct fpga_manager *mgr)
736 {
737 	module_put(mgr->mops_owner);
738 	put_device(&mgr->dev);
739 }
740 EXPORT_SYMBOL_GPL(fpga_mgr_put);
741 
742 /**
743  * fpga_mgr_lock - Lock FPGA manager for exclusive use
744  * @mgr:	fpga manager
745  *
746  * Given a pointer to FPGA Manager (from fpga_mgr_get() or
747  * of_fpga_mgr_put()) attempt to get the mutex. The user should call
748  * fpga_mgr_lock() and verify that it returns 0 before attempting to
749  * program the FPGA.  Likewise, the user should call fpga_mgr_unlock
750  * when done programming the FPGA.
751  *
752  * Return: 0 for success or -EBUSY
753  */
fpga_mgr_lock(struct fpga_manager * mgr)754 int fpga_mgr_lock(struct fpga_manager *mgr)
755 {
756 	if (!mutex_trylock(&mgr->ref_mutex)) {
757 		dev_err(&mgr->dev, "FPGA manager is in use.\n");
758 		return -EBUSY;
759 	}
760 
761 	return 0;
762 }
763 EXPORT_SYMBOL_GPL(fpga_mgr_lock);
764 
765 /**
766  * fpga_mgr_unlock - Unlock FPGA manager after done programming
767  * @mgr:	fpga manager
768  */
fpga_mgr_unlock(struct fpga_manager * mgr)769 void fpga_mgr_unlock(struct fpga_manager *mgr)
770 {
771 	mutex_unlock(&mgr->ref_mutex);
772 }
773 EXPORT_SYMBOL_GPL(fpga_mgr_unlock);
774 
775 /**
776  * __fpga_mgr_register_full - create and register an FPGA Manager device
777  * @parent:	fpga manager device from pdev
778  * @info:	parameters for fpga manager
779  * @owner:	owner module containing the ops
780  *
781  * The caller of this function is responsible for calling fpga_mgr_unregister().
782  * Using devm_fpga_mgr_register_full() instead is recommended.
783  *
784  * Return: pointer to struct fpga_manager pointer or ERR_PTR()
785  */
786 struct fpga_manager *
__fpga_mgr_register_full(struct device * parent,const struct fpga_manager_info * info,struct module * owner)787 __fpga_mgr_register_full(struct device *parent, const struct fpga_manager_info *info,
788 			 struct module *owner)
789 {
790 	const struct fpga_manager_ops *mops = info->mops;
791 	struct fpga_manager *mgr;
792 	int id, ret;
793 
794 	if (!mops) {
795 		dev_err(parent, "Attempt to register without fpga_manager_ops\n");
796 		return ERR_PTR(-EINVAL);
797 	}
798 
799 	if (!info->name || !strlen(info->name)) {
800 		dev_err(parent, "Attempt to register with no name!\n");
801 		return ERR_PTR(-EINVAL);
802 	}
803 
804 	mgr = kzalloc(sizeof(*mgr), GFP_KERNEL);
805 	if (!mgr)
806 		return ERR_PTR(-ENOMEM);
807 
808 	id = ida_alloc(&fpga_mgr_ida, GFP_KERNEL);
809 	if (id < 0) {
810 		ret = id;
811 		goto error_kfree;
812 	}
813 
814 	mutex_init(&mgr->ref_mutex);
815 
816 	mgr->mops_owner = owner;
817 
818 	mgr->name = info->name;
819 	mgr->mops = info->mops;
820 	mgr->priv = info->priv;
821 	mgr->compat_id = info->compat_id;
822 
823 	mgr->dev.class = &fpga_mgr_class;
824 	mgr->dev.groups = mops->groups;
825 	mgr->dev.parent = parent;
826 	mgr->dev.of_node = parent->of_node;
827 	mgr->dev.id = id;
828 
829 	ret = dev_set_name(&mgr->dev, "fpga%d", id);
830 	if (ret)
831 		goto error_device;
832 
833 	/*
834 	 * Initialize framework state by requesting low level driver read state
835 	 * from device.  FPGA may be in reset mode or may have been programmed
836 	 * by bootloader or EEPROM.
837 	 */
838 	mgr->state = fpga_mgr_state(mgr);
839 
840 	ret = device_register(&mgr->dev);
841 	if (ret) {
842 		put_device(&mgr->dev);
843 		return ERR_PTR(ret);
844 	}
845 
846 	return mgr;
847 
848 error_device:
849 	ida_free(&fpga_mgr_ida, id);
850 error_kfree:
851 	kfree(mgr);
852 
853 	return ERR_PTR(ret);
854 }
855 EXPORT_SYMBOL_GPL(__fpga_mgr_register_full);
856 
857 /**
858  * __fpga_mgr_register - create and register an FPGA Manager device
859  * @parent:	fpga manager device from pdev
860  * @name:	fpga manager name
861  * @mops:	pointer to structure of fpga manager ops
862  * @priv:	fpga manager private data
863  * @owner:	owner module containing the ops
864  *
865  * The caller of this function is responsible for calling fpga_mgr_unregister().
866  * Using devm_fpga_mgr_register() instead is recommended. This simple
867  * version of the register function should be sufficient for most users. The
868  * fpga_mgr_register_full() function is available for users that need to pass
869  * additional, optional parameters.
870  *
871  * Return: pointer to struct fpga_manager pointer or ERR_PTR()
872  */
873 struct fpga_manager *
__fpga_mgr_register(struct device * parent,const char * name,const struct fpga_manager_ops * mops,void * priv,struct module * owner)874 __fpga_mgr_register(struct device *parent, const char *name,
875 		    const struct fpga_manager_ops *mops, void *priv, struct module *owner)
876 {
877 	struct fpga_manager_info info = { 0 };
878 
879 	info.name = name;
880 	info.mops = mops;
881 	info.priv = priv;
882 
883 	return __fpga_mgr_register_full(parent, &info, owner);
884 }
885 EXPORT_SYMBOL_GPL(__fpga_mgr_register);
886 
887 /**
888  * fpga_mgr_unregister - unregister an FPGA manager
889  * @mgr: fpga manager struct
890  *
891  * This function is intended for use in an FPGA manager driver's remove function.
892  */
fpga_mgr_unregister(struct fpga_manager * mgr)893 void fpga_mgr_unregister(struct fpga_manager *mgr)
894 {
895 	dev_info(&mgr->dev, "%s %s\n", __func__, mgr->name);
896 
897 	/*
898 	 * If the low level driver provides a method for putting fpga into
899 	 * a desired state upon unregister, do it.
900 	 */
901 	fpga_mgr_fpga_remove(mgr);
902 
903 	device_unregister(&mgr->dev);
904 }
905 EXPORT_SYMBOL_GPL(fpga_mgr_unregister);
906 
devm_fpga_mgr_unregister(struct device * dev,void * res)907 static void devm_fpga_mgr_unregister(struct device *dev, void *res)
908 {
909 	struct fpga_mgr_devres *dr = res;
910 
911 	fpga_mgr_unregister(dr->mgr);
912 }
913 
914 /**
915  * __devm_fpga_mgr_register_full - resource managed variant of fpga_mgr_register()
916  * @parent:	fpga manager device from pdev
917  * @info:	parameters for fpga manager
918  * @owner:	owner module containing the ops
919  *
920  * Return:  fpga manager pointer on success, negative error code otherwise.
921  *
922  * This is the devres variant of fpga_mgr_register_full() for which the unregister
923  * function will be called automatically when the managing device is detached.
924  */
925 struct fpga_manager *
__devm_fpga_mgr_register_full(struct device * parent,const struct fpga_manager_info * info,struct module * owner)926 __devm_fpga_mgr_register_full(struct device *parent, const struct fpga_manager_info *info,
927 			      struct module *owner)
928 {
929 	struct fpga_mgr_devres *dr;
930 	struct fpga_manager *mgr;
931 
932 	dr = devres_alloc(devm_fpga_mgr_unregister, sizeof(*dr), GFP_KERNEL);
933 	if (!dr)
934 		return ERR_PTR(-ENOMEM);
935 
936 	mgr = __fpga_mgr_register_full(parent, info, owner);
937 	if (IS_ERR(mgr)) {
938 		devres_free(dr);
939 		return mgr;
940 	}
941 
942 	dr->mgr = mgr;
943 	devres_add(parent, dr);
944 
945 	return mgr;
946 }
947 EXPORT_SYMBOL_GPL(__devm_fpga_mgr_register_full);
948 
949 /**
950  * __devm_fpga_mgr_register - resource managed variant of fpga_mgr_register()
951  * @parent:	fpga manager device from pdev
952  * @name:	fpga manager name
953  * @mops:	pointer to structure of fpga manager ops
954  * @priv:	fpga manager private data
955  * @owner:	owner module containing the ops
956  *
957  * Return:  fpga manager pointer on success, negative error code otherwise.
958  *
959  * This is the devres variant of fpga_mgr_register() for which the
960  * unregister function will be called automatically when the managing
961  * device is detached.
962  */
963 struct fpga_manager *
__devm_fpga_mgr_register(struct device * parent,const char * name,const struct fpga_manager_ops * mops,void * priv,struct module * owner)964 __devm_fpga_mgr_register(struct device *parent, const char *name,
965 			 const struct fpga_manager_ops *mops, void *priv,
966 			 struct module *owner)
967 {
968 	struct fpga_manager_info info = { 0 };
969 
970 	info.name = name;
971 	info.mops = mops;
972 	info.priv = priv;
973 
974 	return __devm_fpga_mgr_register_full(parent, &info, owner);
975 }
976 EXPORT_SYMBOL_GPL(__devm_fpga_mgr_register);
977 
fpga_mgr_dev_release(struct device * dev)978 static void fpga_mgr_dev_release(struct device *dev)
979 {
980 	struct fpga_manager *mgr = to_fpga_manager(dev);
981 
982 	ida_free(&fpga_mgr_ida, mgr->dev.id);
983 	kfree(mgr);
984 }
985 
986 static const struct class fpga_mgr_class = {
987 	.name = "fpga_manager",
988 	.dev_groups = fpga_mgr_groups,
989 	.dev_release = fpga_mgr_dev_release,
990 };
991 
fpga_mgr_class_init(void)992 static int __init fpga_mgr_class_init(void)
993 {
994 	pr_info("FPGA manager framework\n");
995 
996 	return class_register(&fpga_mgr_class);
997 }
998 
fpga_mgr_class_exit(void)999 static void __exit fpga_mgr_class_exit(void)
1000 {
1001 	class_unregister(&fpga_mgr_class);
1002 	ida_destroy(&fpga_mgr_ida);
1003 }
1004 
1005 MODULE_AUTHOR("Alan Tull <atull@kernel.org>");
1006 MODULE_DESCRIPTION("FPGA manager framework");
1007 MODULE_LICENSE("GPL v2");
1008 
1009 subsys_initcall(fpga_mgr_class_init);
1010 module_exit(fpga_mgr_class_exit);
1011