86 	struct img_hash_dev	*hdev;  member
113 	struct img_hash_dev	*hdev;  member
150 static inline u32 img_hash_read(struct img_hash_dev *hdev, u32 offset)  in img_hash_read()  argument
152 	return readl_relaxed(hdev->io_base + offset);  in img_hash_read()
155 static inline void img_hash_write(struct img_hash_dev *hdev,  in img_hash_write()  argument
158 	writel_relaxed(value, hdev->io_base + offset);  in img_hash_write()
161 static inline u32 img_hash_read_result_queue(struct img_hash_dev *hdev)  in img_hash_read_result_queue()  argument
163 	return be32_to_cpu(img_hash_read(hdev, CR_RESULT_QUEUE));  in img_hash_read_result_queue()
166 static void img_hash_start(struct img_hash_dev *hdev, bool dma)  in img_hash_start()  argument
168 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_start()
179 	dev_dbg(hdev->dev, "Starting hash process\n");  in img_hash_start()
180 	img_hash_write(hdev, CR_CONTROL, cr);  in img_hash_start()
189 		img_hash_read(hdev, CR_CONTROL);  in img_hash_start()
192 static int img_hash_xmit_cpu(struct img_hash_dev *hdev, const u8 *buf,  in img_hash_xmit_cpu()  argument
198 	dev_dbg(hdev->dev, "xmit_cpu:  length: %zu bytes\n", length);  in img_hash_xmit_cpu()
201 		hdev->flags |= DRIVER_FLAGS_FINAL;  in img_hash_xmit_cpu()
206 		writel_relaxed(buffer[count], hdev->cpu_addr);  in img_hash_xmit_cpu()
213 	struct img_hash_dev *hdev = (struct img_hash_dev *)data;  in img_hash_dma_callback()  local
214 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_dma_callback()
217 		img_hash_xmit_cpu(hdev, ctx->buffer, ctx->bufcnt, 0);  in img_hash_dma_callback()
221 		tasklet_schedule(&hdev->dma_task);  in img_hash_dma_callback()
224 static int img_hash_xmit_dma(struct img_hash_dev *hdev, struct scatterlist *sg)  in img_hash_xmit_dma()  argument
227 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_xmit_dma()
229 	ctx->dma_ct = dma_map_sg(hdev->dev, sg, 1, DMA_TO_DEVICE);  in img_hash_xmit_dma()
231 		dev_err(hdev->dev, "Invalid DMA sg\n");  in img_hash_xmit_dma()
232 		hdev->err = -EINVAL;  in img_hash_xmit_dma()
236 	desc = dmaengine_prep_slave_sg(hdev->dma_lch,  in img_hash_xmit_dma()
242 		dev_err(hdev->dev, "Null DMA descriptor\n");  in img_hash_xmit_dma()
243 		hdev->err = -EINVAL;  in img_hash_xmit_dma()
244 		dma_unmap_sg(hdev->dev, sg, 1, DMA_TO_DEVICE);  in img_hash_xmit_dma()
248 	desc->callback_param = hdev;  in img_hash_xmit_dma()
250 	dma_async_issue_pending(hdev->dma_lch);  in img_hash_xmit_dma()
255 static int img_hash_write_via_cpu(struct img_hash_dev *hdev)  in img_hash_write_via_cpu()  argument
257 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_write_via_cpu()
259 	ctx->bufcnt = sg_copy_to_buffer(hdev->req->src, sg_nents(ctx->sg),  in img_hash_write_via_cpu()
260 					ctx->buffer, hdev->req->nbytes);  in img_hash_write_via_cpu()
262 	ctx->total = hdev->req->nbytes;  in img_hash_write_via_cpu()
265 	hdev->flags |= (DRIVER_FLAGS_CPU | DRIVER_FLAGS_FINAL);  in img_hash_write_via_cpu()
267 	img_hash_start(hdev, false);  in img_hash_write_via_cpu()
269 	return img_hash_xmit_cpu(hdev, ctx->buffer, ctx->total, 1);  in img_hash_write_via_cpu()
291 		hash[i] = img_hash_read_result_queue(ctx->hdev);  in img_hash_copy_hash()
297 	struct img_hash_dev *hdev =  ctx->hdev;  in img_hash_finish_req()  local
301 		if (DRIVER_FLAGS_FINAL & hdev->flags)  in img_hash_finish_req()
304 		dev_warn(hdev->dev, "Hash failed with error %d\n", err);  in img_hash_finish_req()
308 	hdev->flags &= ~(DRIVER_FLAGS_DMA_READY | DRIVER_FLAGS_OUTPUT_READY |  in img_hash_finish_req()
315 static int img_hash_write_via_dma(struct img_hash_dev *hdev)  in img_hash_write_via_dma()  argument
317 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_write_via_dma()
319 	img_hash_start(hdev, true);  in img_hash_write_via_dma()
321 	dev_dbg(hdev->dev, "xmit dma size: %d\n", ctx->total);  in img_hash_write_via_dma()
324 		hdev->flags |= DRIVER_FLAGS_FINAL;  in img_hash_write_via_dma()
326 	hdev->flags |= DRIVER_FLAGS_DMA_ACTIVE | DRIVER_FLAGS_FINAL;  in img_hash_write_via_dma()
328 	tasklet_schedule(&hdev->dma_task);  in img_hash_write_via_dma()
333 static int img_hash_dma_init(struct img_hash_dev *hdev)  in img_hash_dma_init()  argument
338 	hdev->dma_lch = dma_request_slave_channel(hdev->dev, "tx");  in img_hash_dma_init()
339 	if (!hdev->dma_lch) {  in img_hash_dma_init()
340 		dev_err(hdev->dev, "Couldn't acquire a slave DMA channel.\n");  in img_hash_dma_init()
344 	dma_conf.dst_addr = hdev->bus_addr;  in img_hash_dma_init()
349 	err = dmaengine_slave_config(hdev->dma_lch,  &dma_conf);  in img_hash_dma_init()
351 		dev_err(hdev->dev, "Couldn't configure DMA slave.\n");  in img_hash_dma_init()
352 		dma_release_channel(hdev->dma_lch);  in img_hash_dma_init()
361 	struct img_hash_dev *hdev = (struct img_hash_dev *)d;  in img_hash_dma_task()  local
362 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_dma_task()
367 	if (!hdev->req || !ctx->sg)  in img_hash_dma_task()
388 		if (img_hash_xmit_dma(hdev, &tsg)) {  in img_hash_dma_task()
389 			dev_err(hdev->dev, "DMA failed, falling back to CPU");  in img_hash_dma_task()
391 			hdev->err = 0;  in img_hash_dma_task()
392 			img_hash_xmit_cpu(hdev, addr + ctx->offset,  in img_hash_dma_task()
424 			img_hash_dma_callback(hdev);  in img_hash_dma_task()
431 static int img_hash_write_via_dma_stop(struct img_hash_dev *hdev)  in img_hash_write_via_dma_stop()  argument
433 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_write_via_dma_stop()
436 		dma_unmap_sg(hdev->dev, ctx->sg, ctx->dma_ct, DMA_TO_DEVICE);  in img_hash_write_via_dma_stop()
441 static int img_hash_process_data(struct img_hash_dev *hdev)  in img_hash_process_data()  argument
443 	struct ahash_request *req = hdev->req;  in img_hash_process_data()
450 		dev_dbg(hdev->dev, "process data request(%d bytes) using DMA\n",  in img_hash_process_data()
452 		err = img_hash_write_via_dma(hdev);  in img_hash_process_data()
454 		dev_dbg(hdev->dev, "process data request(%d bytes) using CPU\n",  in img_hash_process_data()
456 		err = img_hash_write_via_cpu(hdev);  in img_hash_process_data()
461 static int img_hash_hw_init(struct img_hash_dev *hdev)  in img_hash_hw_init()  argument
466 	img_hash_write(hdev, CR_RESET, CR_RESET_SET);  in img_hash_hw_init()
467 	img_hash_write(hdev, CR_RESET, CR_RESET_UNSET);  in img_hash_hw_init()
468 	img_hash_write(hdev, CR_INTENAB, CR_INT_NEW_RESULTS_SET);  in img_hash_hw_init()
470 	nbits = (u64)hdev->req->nbytes << 3;  in img_hash_hw_init()
473 	img_hash_write(hdev, CR_MESSAGE_LENGTH_H, u);  in img_hash_hw_init()
474 	img_hash_write(hdev, CR_MESSAGE_LENGTH_L, l);  in img_hash_hw_init()
476 	if (!(DRIVER_FLAGS_INIT & hdev->flags)) {  in img_hash_hw_init()
477 		hdev->flags |= DRIVER_FLAGS_INIT;  in img_hash_hw_init()
478 		hdev->err = 0;  in img_hash_hw_init()
480 	dev_dbg(hdev->dev, "hw initialized, nbits: %llx\n", nbits);  in img_hash_hw_init()
497 static int img_hash_handle_queue(struct img_hash_dev *hdev,  in img_hash_handle_queue()  argument
505 	spin_lock_irqsave(&hdev->lock, flags);  in img_hash_handle_queue()
508 		res = ahash_enqueue_request(&hdev->queue, req);  in img_hash_handle_queue()
510 	if (DRIVER_FLAGS_BUSY & hdev->flags) {  in img_hash_handle_queue()
511 		spin_unlock_irqrestore(&hdev->lock, flags);  in img_hash_handle_queue()
515 	backlog = crypto_get_backlog(&hdev->queue);  in img_hash_handle_queue()
516 	async_req = crypto_dequeue_request(&hdev->queue);  in img_hash_handle_queue()
518 		hdev->flags |= DRIVER_FLAGS_BUSY;  in img_hash_handle_queue()
520 	spin_unlock_irqrestore(&hdev->lock, flags);  in img_hash_handle_queue()
529 	hdev->req = req;  in img_hash_handle_queue()
533 	dev_info(hdev->dev, "processing req, op: %lu, bytes: %d\n",  in img_hash_handle_queue()
536 	err = img_hash_hw_init(hdev);  in img_hash_handle_queue()
539 		err = img_hash_process_data(hdev);  in img_hash_handle_queue()
624 	struct img_hash_dev *hdev = NULL;  in img_hash_digest()  local
629 	if (!tctx->hdev) {  in img_hash_digest()
631 			hdev = tmp;  in img_hash_digest()
634 		tctx->hdev = hdev;  in img_hash_digest()
637 		hdev = tctx->hdev;  in img_hash_digest()
641 	ctx->hdev = hdev;  in img_hash_digest()
670 	err = img_hash_handle_queue(tctx->hdev, req);  in img_hash_digest()
727 	struct img_hash_dev *hdev = dev_id;  in img_irq_handler()  local
730 	reg = img_hash_read(hdev, CR_INTSTAT);  in img_irq_handler()
731 	img_hash_write(hdev, CR_INTCLEAR, reg);  in img_irq_handler()
734 		dev_dbg(hdev->dev, "IRQ CR_INT_NEW_RESULTS_SET\n");  in img_irq_handler()
735 		if (DRIVER_FLAGS_BUSY & hdev->flags) {  in img_irq_handler()
736 			hdev->flags |= DRIVER_FLAGS_OUTPUT_READY;  in img_irq_handler()
737 			if (!(DRIVER_FLAGS_CPU & hdev->flags))  in img_irq_handler()
738 				hdev->flags |= DRIVER_FLAGS_DMA_READY;  in img_irq_handler()
739 			tasklet_schedule(&hdev->done_task);  in img_irq_handler()
741 			dev_warn(hdev->dev,  in img_irq_handler()
745 		dev_warn(hdev->dev,  in img_irq_handler()
748 		dev_warn(hdev->dev,  in img_irq_handler()
751 		dev_warn(hdev->dev,  in img_irq_handler()
864 static int img_register_algs(struct img_hash_dev *hdev)  in img_register_algs()  argument
882 static int img_unregister_algs(struct img_hash_dev *hdev)  in img_unregister_algs()  argument
893 	struct img_hash_dev *hdev = (struct img_hash_dev *)data;  in img_hash_done_task()  local
896 	if (hdev->err == -EINVAL) {  in img_hash_done_task()
897 		err = hdev->err;  in img_hash_done_task()
901 	if (!(DRIVER_FLAGS_BUSY & hdev->flags)) {  in img_hash_done_task()
902 		img_hash_handle_queue(hdev, NULL);  in img_hash_done_task()
906 	if (DRIVER_FLAGS_CPU & hdev->flags) {  in img_hash_done_task()
907 		if (DRIVER_FLAGS_OUTPUT_READY & hdev->flags) {  in img_hash_done_task()
908 			hdev->flags &= ~DRIVER_FLAGS_OUTPUT_READY;  in img_hash_done_task()
911 	} else if (DRIVER_FLAGS_DMA_READY & hdev->flags) {  in img_hash_done_task()
912 		if (DRIVER_FLAGS_DMA_ACTIVE & hdev->flags) {  in img_hash_done_task()
913 			hdev->flags &= ~DRIVER_FLAGS_DMA_ACTIVE;  in img_hash_done_task()
914 			img_hash_write_via_dma_stop(hdev);  in img_hash_done_task()
915 			if (hdev->err) {  in img_hash_done_task()
916 				err = hdev->err;  in img_hash_done_task()
920 		if (DRIVER_FLAGS_OUTPUT_READY & hdev->flags) {  in img_hash_done_task()
921 			hdev->flags &= ~(DRIVER_FLAGS_DMA_READY |  in img_hash_done_task()
929 	img_hash_finish_req(hdev->req, err);  in img_hash_done_task()
940 	struct img_hash_dev *hdev;  in img_hash_probe()  local
946 	hdev = devm_kzalloc(dev, sizeof(*hdev), GFP_KERNEL);  in img_hash_probe()
947 	if (hdev == NULL)  in img_hash_probe()
950 	spin_lock_init(&hdev->lock);  in img_hash_probe()
952 	hdev->dev = dev;  in img_hash_probe()
954 	platform_set_drvdata(pdev, hdev);  in img_hash_probe()
956 	INIT_LIST_HEAD(&hdev->list);  in img_hash_probe()
958 	tasklet_init(&hdev->done_task, img_hash_done_task, (unsigned long)hdev);  in img_hash_probe()
959 	tasklet_init(&hdev->dma_task, img_hash_dma_task, (unsigned long)hdev);  in img_hash_probe()
961 	crypto_init_queue(&hdev->queue, IMG_HASH_QUEUE_LENGTH);  in img_hash_probe()
966 	hdev->io_base = devm_ioremap_resource(dev, hash_res);  in img_hash_probe()
967 	if (IS_ERR(hdev->io_base)) {  in img_hash_probe()
968 		err = PTR_ERR(hdev->io_base);  in img_hash_probe()
976 	hdev->cpu_addr = devm_ioremap_resource(dev, hash_res);  in img_hash_probe()
977 	if (IS_ERR(hdev->cpu_addr)) {  in img_hash_probe()
979 		err = PTR_ERR(hdev->cpu_addr);  in img_hash_probe()
982 	hdev->bus_addr = hash_res->start;  in img_hash_probe()
992 			       dev_name(dev), hdev);  in img_hash_probe()
999 	hdev->hash_clk = devm_clk_get(&pdev->dev, "hash");  in img_hash_probe()
1000 	if (IS_ERR(hdev->hash_clk)) {  in img_hash_probe()
1002 		err = PTR_ERR(hdev->hash_clk);  in img_hash_probe()
1006 	hdev->sys_clk = devm_clk_get(&pdev->dev, "sys");  in img_hash_probe()
1007 	if (IS_ERR(hdev->sys_clk)) {  in img_hash_probe()
1009 		err = PTR_ERR(hdev->sys_clk);  in img_hash_probe()
1013 	err = clk_prepare_enable(hdev->hash_clk);  in img_hash_probe()
1017 	err = clk_prepare_enable(hdev->sys_clk);  in img_hash_probe()
1021 	err = img_hash_dma_init(hdev);  in img_hash_probe()
1026 		dma_chan_name(hdev->dma_lch));  in img_hash_probe()
1029 	list_add_tail(&hdev->list, &img_hash.dev_list);  in img_hash_probe()
1032 	err = img_register_algs(hdev);  in img_hash_probe()
1041 	list_del(&hdev->list);  in img_hash_probe()
1043 	dma_release_channel(hdev->dma_lch);  in img_hash_probe()
1045 	clk_disable_unprepare(hdev->sys_clk);  in img_hash_probe()
1047 	clk_disable_unprepare(hdev->hash_clk);  in img_hash_probe()
1049 	tasklet_kill(&hdev->done_task);  in img_hash_probe()
1050 	tasklet_kill(&hdev->dma_task);  in img_hash_probe()
1057 	struct img_hash_dev *hdev;  in img_hash_remove()  local
1059 	hdev = platform_get_drvdata(pdev);  in img_hash_remove()
1061 	list_del(&hdev->list);  in img_hash_remove()
1064 	img_unregister_algs(hdev);  in img_hash_remove()
1066 	tasklet_kill(&hdev->done_task);  in img_hash_remove()
1067 	tasklet_kill(&hdev->dma_task);  in img_hash_remove()
1069 	dma_release_channel(hdev->dma_lch);  in img_hash_remove()
1071 	clk_disable_unprepare(hdev->hash_clk);  in img_hash_remove()
1072 	clk_disable_unprepare(hdev->sys_clk);  in img_hash_remove()
1080 	struct img_hash_dev *hdev = dev_get_drvdata(dev);  in img_hash_suspend()  local
1082 	clk_disable_unprepare(hdev->hash_clk);  in img_hash_suspend()
1083 	clk_disable_unprepare(hdev->sys_clk);  in img_hash_suspend()
1090 	struct img_hash_dev *hdev = dev_get_drvdata(dev);  in img_hash_resume()  local
1093 	ret = clk_prepare_enable(hdev->hash_clk);  in img_hash_resume()
1097 	ret = clk_prepare_enable(hdev->sys_clk);  in img_hash_resume()
1099 		clk_disable_unprepare(hdev->hash_clk);  in img_hash_resume()