85 	struct img_hash_dev	*hdev;  member
112 	struct img_hash_dev	*hdev;  member
149 static inline u32 img_hash_read(struct img_hash_dev *hdev, u32 offset)  in img_hash_read()  argument
151 	return readl_relaxed(hdev->io_base + offset);  in img_hash_read()
154 static inline void img_hash_write(struct img_hash_dev *hdev,  in img_hash_write()  argument
157 	writel_relaxed(value, hdev->io_base + offset);  in img_hash_write()
160 static inline u32 img_hash_read_result_queue(struct img_hash_dev *hdev)  in img_hash_read_result_queue()  argument
162 	return be32_to_cpu(img_hash_read(hdev, CR_RESULT_QUEUE));  in img_hash_read_result_queue()
165 static void img_hash_start(struct img_hash_dev *hdev, bool dma)  in img_hash_start()  argument
167 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_start()
178 	dev_dbg(hdev->dev, "Starting hash process\n");  in img_hash_start()
179 	img_hash_write(hdev, CR_CONTROL, cr);  in img_hash_start()
188 		img_hash_read(hdev, CR_CONTROL);  in img_hash_start()
191 static int img_hash_xmit_cpu(struct img_hash_dev *hdev, const u8 *buf,  in img_hash_xmit_cpu()  argument
197 	dev_dbg(hdev->dev, "xmit_cpu:  length: %zu bytes\n", length);  in img_hash_xmit_cpu()
200 		hdev->flags |= DRIVER_FLAGS_FINAL;  in img_hash_xmit_cpu()
205 		writel_relaxed(buffer[count], hdev->cpu_addr);  in img_hash_xmit_cpu()
212 	struct img_hash_dev *hdev = (struct img_hash_dev *)data;  in img_hash_dma_callback()  local
213 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_dma_callback()
216 		img_hash_xmit_cpu(hdev, ctx->buffer, ctx->bufcnt, 0);  in img_hash_dma_callback()
220 		tasklet_schedule(&hdev->dma_task);  in img_hash_dma_callback()
223 static int img_hash_xmit_dma(struct img_hash_dev *hdev, struct scatterlist *sg)  in img_hash_xmit_dma()  argument
226 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_xmit_dma()
228 	ctx->dma_ct = dma_map_sg(hdev->dev, sg, 1, DMA_TO_DEVICE);  in img_hash_xmit_dma()
230 		dev_err(hdev->dev, "Invalid DMA sg\n");  in img_hash_xmit_dma()
231 		hdev->err = -EINVAL;  in img_hash_xmit_dma()
235 	desc = dmaengine_prep_slave_sg(hdev->dma_lch,  in img_hash_xmit_dma()
241 		dev_err(hdev->dev, "Null DMA descriptor\n");  in img_hash_xmit_dma()
242 		hdev->err = -EINVAL;  in img_hash_xmit_dma()
243 		dma_unmap_sg(hdev->dev, sg, 1, DMA_TO_DEVICE);  in img_hash_xmit_dma()
247 	desc->callback_param = hdev;  in img_hash_xmit_dma()
249 	dma_async_issue_pending(hdev->dma_lch);  in img_hash_xmit_dma()
254 static int img_hash_write_via_cpu(struct img_hash_dev *hdev)  in img_hash_write_via_cpu()  argument
256 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_write_via_cpu()
258 	ctx->bufcnt = sg_copy_to_buffer(hdev->req->src, sg_nents(ctx->sg),  in img_hash_write_via_cpu()
259 					ctx->buffer, hdev->req->nbytes);  in img_hash_write_via_cpu()
261 	ctx->total = hdev->req->nbytes;  in img_hash_write_via_cpu()
264 	hdev->flags |= (DRIVER_FLAGS_CPU | DRIVER_FLAGS_FINAL);  in img_hash_write_via_cpu()
266 	img_hash_start(hdev, false);  in img_hash_write_via_cpu()
268 	return img_hash_xmit_cpu(hdev, ctx->buffer, ctx->total, 1);  in img_hash_write_via_cpu()
290 		hash[i] = img_hash_read_result_queue(ctx->hdev);  in img_hash_copy_hash()
296 	struct img_hash_dev *hdev =  ctx->hdev;  in img_hash_finish_req()  local
300 		if (DRIVER_FLAGS_FINAL & hdev->flags)  in img_hash_finish_req()
303 		dev_warn(hdev->dev, "Hash failed with error %d\n", err);  in img_hash_finish_req()
307 	hdev->flags &= ~(DRIVER_FLAGS_DMA_READY | DRIVER_FLAGS_OUTPUT_READY |  in img_hash_finish_req()
314 static int img_hash_write_via_dma(struct img_hash_dev *hdev)  in img_hash_write_via_dma()  argument
316 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_write_via_dma()
318 	img_hash_start(hdev, true);  in img_hash_write_via_dma()
320 	dev_dbg(hdev->dev, "xmit dma size: %d\n", ctx->total);  in img_hash_write_via_dma()
323 		hdev->flags |= DRIVER_FLAGS_FINAL;  in img_hash_write_via_dma()
325 	hdev->flags |= DRIVER_FLAGS_DMA_ACTIVE | DRIVER_FLAGS_FINAL;  in img_hash_write_via_dma()
327 	tasklet_schedule(&hdev->dma_task);  in img_hash_write_via_dma()
332 static int img_hash_dma_init(struct img_hash_dev *hdev)  in img_hash_dma_init()  argument
337 	hdev->dma_lch = dma_request_chan(hdev->dev, "tx");  in img_hash_dma_init()
338 	if (IS_ERR(hdev->dma_lch)) {  in img_hash_dma_init()
339 		dev_err(hdev->dev, "Couldn't acquire a slave DMA channel.\n");  in img_hash_dma_init()
340 		return PTR_ERR(hdev->dma_lch);  in img_hash_dma_init()
343 	dma_conf.dst_addr = hdev->bus_addr;  in img_hash_dma_init()
348 	err = dmaengine_slave_config(hdev->dma_lch,  &dma_conf);  in img_hash_dma_init()
350 		dev_err(hdev->dev, "Couldn't configure DMA slave.\n");  in img_hash_dma_init()
351 		dma_release_channel(hdev->dma_lch);  in img_hash_dma_init()
360 	struct img_hash_dev *hdev = (struct img_hash_dev *)d;  in img_hash_dma_task()  local
361 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_dma_task()
366 	if (!hdev->req || !ctx->sg)  in img_hash_dma_task()
387 		if (img_hash_xmit_dma(hdev, &tsg)) {  in img_hash_dma_task()
388 			dev_err(hdev->dev, "DMA failed, falling back to CPU");  in img_hash_dma_task()
390 			hdev->err = 0;  in img_hash_dma_task()
391 			img_hash_xmit_cpu(hdev, addr + ctx->offset,  in img_hash_dma_task()
423 			img_hash_dma_callback(hdev);  in img_hash_dma_task()
430 static int img_hash_write_via_dma_stop(struct img_hash_dev *hdev)  in img_hash_write_via_dma_stop()  argument
432 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_write_via_dma_stop()
435 		dma_unmap_sg(hdev->dev, ctx->sg, ctx->dma_ct, DMA_TO_DEVICE);  in img_hash_write_via_dma_stop()
440 static int img_hash_process_data(struct img_hash_dev *hdev)  in img_hash_process_data()  argument
442 	struct ahash_request *req = hdev->req;  in img_hash_process_data()
449 		dev_dbg(hdev->dev, "process data request(%d bytes) using DMA\n",  in img_hash_process_data()
451 		err = img_hash_write_via_dma(hdev);  in img_hash_process_data()
453 		dev_dbg(hdev->dev, "process data request(%d bytes) using CPU\n",  in img_hash_process_data()
455 		err = img_hash_write_via_cpu(hdev);  in img_hash_process_data()
460 static int img_hash_hw_init(struct img_hash_dev *hdev)  in img_hash_hw_init()  argument
465 	img_hash_write(hdev, CR_RESET, CR_RESET_SET);  in img_hash_hw_init()
466 	img_hash_write(hdev, CR_RESET, CR_RESET_UNSET);  in img_hash_hw_init()
467 	img_hash_write(hdev, CR_INTENAB, CR_INT_NEW_RESULTS_SET);  in img_hash_hw_init()
469 	nbits = (u64)hdev->req->nbytes << 3;  in img_hash_hw_init()
472 	img_hash_write(hdev, CR_MESSAGE_LENGTH_H, u);  in img_hash_hw_init()
473 	img_hash_write(hdev, CR_MESSAGE_LENGTH_L, l);  in img_hash_hw_init()
475 	if (!(DRIVER_FLAGS_INIT & hdev->flags)) {  in img_hash_hw_init()
476 		hdev->flags |= DRIVER_FLAGS_INIT;  in img_hash_hw_init()
477 		hdev->err = 0;  in img_hash_hw_init()
479 	dev_dbg(hdev->dev, "hw initialized, nbits: %llx\n", nbits);  in img_hash_hw_init()
496 static int img_hash_handle_queue(struct img_hash_dev *hdev,  in img_hash_handle_queue()  argument
504 	spin_lock_irqsave(&hdev->lock, flags);  in img_hash_handle_queue()
507 		res = ahash_enqueue_request(&hdev->queue, req);  in img_hash_handle_queue()
509 	if (DRIVER_FLAGS_BUSY & hdev->flags) {  in img_hash_handle_queue()
510 		spin_unlock_irqrestore(&hdev->lock, flags);  in img_hash_handle_queue()
514 	backlog = crypto_get_backlog(&hdev->queue);  in img_hash_handle_queue()
515 	async_req = crypto_dequeue_request(&hdev->queue);  in img_hash_handle_queue()
517 		hdev->flags |= DRIVER_FLAGS_BUSY;  in img_hash_handle_queue()
519 	spin_unlock_irqrestore(&hdev->lock, flags);  in img_hash_handle_queue()
528 	hdev->req = req;  in img_hash_handle_queue()
532 	dev_info(hdev->dev, "processing req, op: %lu, bytes: %d\n",  in img_hash_handle_queue()
535 	err = img_hash_hw_init(hdev);  in img_hash_handle_queue()
538 		err = img_hash_process_data(hdev);  in img_hash_handle_queue()
623 	struct img_hash_dev *hdev = NULL;  in img_hash_digest()  local
628 	if (!tctx->hdev) {  in img_hash_digest()
630 			hdev = tmp;  in img_hash_digest()
633 		tctx->hdev = hdev;  in img_hash_digest()
636 		hdev = tctx->hdev;  in img_hash_digest()
640 	ctx->hdev = hdev;  in img_hash_digest()
669 	err = img_hash_handle_queue(tctx->hdev, req);  in img_hash_digest()
721 	struct img_hash_dev *hdev = dev_id;  in img_irq_handler()  local
724 	reg = img_hash_read(hdev, CR_INTSTAT);  in img_irq_handler()
725 	img_hash_write(hdev, CR_INTCLEAR, reg);  in img_irq_handler()
728 		dev_dbg(hdev->dev, "IRQ CR_INT_NEW_RESULTS_SET\n");  in img_irq_handler()
729 		if (DRIVER_FLAGS_BUSY & hdev->flags) {  in img_irq_handler()
730 			hdev->flags |= DRIVER_FLAGS_OUTPUT_READY;  in img_irq_handler()
731 			if (!(DRIVER_FLAGS_CPU & hdev->flags))  in img_irq_handler()
732 				hdev->flags |= DRIVER_FLAGS_DMA_READY;  in img_irq_handler()
733 			tasklet_schedule(&hdev->done_task);  in img_irq_handler()
735 			dev_warn(hdev->dev,  in img_irq_handler()
739 		dev_warn(hdev->dev,  in img_irq_handler()
742 		dev_warn(hdev->dev,  in img_irq_handler()
745 		dev_warn(hdev->dev,  in img_irq_handler()
858 static int img_register_algs(struct img_hash_dev *hdev)  in img_register_algs()  argument
876 static int img_unregister_algs(struct img_hash_dev *hdev)  in img_unregister_algs()  argument
887 	struct img_hash_dev *hdev = (struct img_hash_dev *)data;  in img_hash_done_task()  local
890 	if (hdev->err == -EINVAL) {  in img_hash_done_task()
891 		err = hdev->err;  in img_hash_done_task()
895 	if (!(DRIVER_FLAGS_BUSY & hdev->flags)) {  in img_hash_done_task()
896 		img_hash_handle_queue(hdev, NULL);  in img_hash_done_task()
900 	if (DRIVER_FLAGS_CPU & hdev->flags) {  in img_hash_done_task()
901 		if (DRIVER_FLAGS_OUTPUT_READY & hdev->flags) {  in img_hash_done_task()
902 			hdev->flags &= ~DRIVER_FLAGS_OUTPUT_READY;  in img_hash_done_task()
905 	} else if (DRIVER_FLAGS_DMA_READY & hdev->flags) {  in img_hash_done_task()
906 		if (DRIVER_FLAGS_DMA_ACTIVE & hdev->flags) {  in img_hash_done_task()
907 			hdev->flags &= ~DRIVER_FLAGS_DMA_ACTIVE;  in img_hash_done_task()
908 			img_hash_write_via_dma_stop(hdev);  in img_hash_done_task()
909 			if (hdev->err) {  in img_hash_done_task()
910 				err = hdev->err;  in img_hash_done_task()
914 		if (DRIVER_FLAGS_OUTPUT_READY & hdev->flags) {  in img_hash_done_task()
915 			hdev->flags &= ~(DRIVER_FLAGS_DMA_READY |  in img_hash_done_task()
923 	img_hash_finish_req(hdev->req, err);  in img_hash_done_task()
934 	struct img_hash_dev *hdev;  in img_hash_probe()  local
940 	hdev = devm_kzalloc(dev, sizeof(*hdev), GFP_KERNEL);  in img_hash_probe()
941 	if (hdev == NULL)  in img_hash_probe()
944 	spin_lock_init(&hdev->lock);  in img_hash_probe()
946 	hdev->dev = dev;  in img_hash_probe()
948 	platform_set_drvdata(pdev, hdev);  in img_hash_probe()
950 	INIT_LIST_HEAD(&hdev->list);  in img_hash_probe()
952 	tasklet_init(&hdev->done_task, img_hash_done_task, (unsigned long)hdev);  in img_hash_probe()
953 	tasklet_init(&hdev->dma_task, img_hash_dma_task, (unsigned long)hdev);  in img_hash_probe()
955 	crypto_init_queue(&hdev->queue, IMG_HASH_QUEUE_LENGTH);  in img_hash_probe()
958 	hdev->io_base = devm_platform_ioremap_resource(pdev, 0);  in img_hash_probe()
959 	if (IS_ERR(hdev->io_base)) {  in img_hash_probe()
960 		err = PTR_ERR(hdev->io_base);  in img_hash_probe()
966 	hdev->cpu_addr = devm_ioremap_resource(dev, hash_res);  in img_hash_probe()
967 	if (IS_ERR(hdev->cpu_addr)) {  in img_hash_probe()
968 		err = PTR_ERR(hdev->cpu_addr);  in img_hash_probe()
971 	hdev->bus_addr = hash_res->start;  in img_hash_probe()
980 			       dev_name(dev), hdev);  in img_hash_probe()
987 	hdev->hash_clk = devm_clk_get(&pdev->dev, "hash");  in img_hash_probe()
988 	if (IS_ERR(hdev->hash_clk)) {  in img_hash_probe()
990 		err = PTR_ERR(hdev->hash_clk);  in img_hash_probe()
994 	hdev->sys_clk = devm_clk_get(&pdev->dev, "sys");  in img_hash_probe()
995 	if (IS_ERR(hdev->sys_clk)) {  in img_hash_probe()
997 		err = PTR_ERR(hdev->sys_clk);  in img_hash_probe()
1001 	err = clk_prepare_enable(hdev->hash_clk);  in img_hash_probe()
1005 	err = clk_prepare_enable(hdev->sys_clk);  in img_hash_probe()
1009 	err = img_hash_dma_init(hdev);  in img_hash_probe()
1014 		dma_chan_name(hdev->dma_lch));  in img_hash_probe()
1017 	list_add_tail(&hdev->list, &img_hash.dev_list);  in img_hash_probe()
1020 	err = img_register_algs(hdev);  in img_hash_probe()
1029 	list_del(&hdev->list);  in img_hash_probe()
1031 	dma_release_channel(hdev->dma_lch);  in img_hash_probe()
1033 	clk_disable_unprepare(hdev->sys_clk);  in img_hash_probe()
1035 	clk_disable_unprepare(hdev->hash_clk);  in img_hash_probe()
1037 	tasklet_kill(&hdev->done_task);  in img_hash_probe()
1038 	tasklet_kill(&hdev->dma_task);  in img_hash_probe()
1045 	struct img_hash_dev *hdev;  in img_hash_remove()  local
1047 	hdev = platform_get_drvdata(pdev);  in img_hash_remove()
1049 	list_del(&hdev->list);  in img_hash_remove()
1052 	img_unregister_algs(hdev);  in img_hash_remove()
1054 	tasklet_kill(&hdev->done_task);  in img_hash_remove()
1055 	tasklet_kill(&hdev->dma_task);  in img_hash_remove()
1057 	dma_release_channel(hdev->dma_lch);  in img_hash_remove()
1059 	clk_disable_unprepare(hdev->hash_clk);  in img_hash_remove()
1060 	clk_disable_unprepare(hdev->sys_clk);  in img_hash_remove()
1068 	struct img_hash_dev *hdev = dev_get_drvdata(dev);  in img_hash_suspend()  local
1070 	clk_disable_unprepare(hdev->hash_clk);  in img_hash_suspend()
1071 	clk_disable_unprepare(hdev->sys_clk);  in img_hash_suspend()
1078 	struct img_hash_dev *hdev = dev_get_drvdata(dev);  in img_hash_resume()  local
1081 	ret = clk_prepare_enable(hdev->hash_clk);  in img_hash_resume()
1085 	ret = clk_prepare_enable(hdev->sys_clk);  in img_hash_resume()
1087 		clk_disable_unprepare(hdev->hash_clk);  in img_hash_resume()