85 	struct img_hash_dev	*hdev;  member
110 	struct img_hash_dev	*hdev;  member
147 static inline u32 img_hash_read(struct img_hash_dev *hdev, u32 offset)  in img_hash_read()  argument
149 	return readl_relaxed(hdev->io_base + offset);  in img_hash_read()
152 static inline void img_hash_write(struct img_hash_dev *hdev,  in img_hash_write()  argument
155 	writel_relaxed(value, hdev->io_base + offset);  in img_hash_write()
158 static inline u32 img_hash_read_result_queue(struct img_hash_dev *hdev)  in img_hash_read_result_queue()  argument
160 	return be32_to_cpu(img_hash_read(hdev, CR_RESULT_QUEUE));  in img_hash_read_result_queue()
163 static void img_hash_start(struct img_hash_dev *hdev, bool dma)  in img_hash_start()  argument
165 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_start()
176 	dev_dbg(hdev->dev, "Starting hash process\n");  in img_hash_start()
177 	img_hash_write(hdev, CR_CONTROL, cr);  in img_hash_start()
186 		img_hash_read(hdev, CR_CONTROL);  in img_hash_start()
189 static int img_hash_xmit_cpu(struct img_hash_dev *hdev, const u8 *buf,  in img_hash_xmit_cpu()  argument
195 	dev_dbg(hdev->dev, "xmit_cpu:  length: %zu bytes\n", length);  in img_hash_xmit_cpu()
198 		hdev->flags |= DRIVER_FLAGS_FINAL;  in img_hash_xmit_cpu()
203 		writel_relaxed(buffer[count], hdev->cpu_addr);  in img_hash_xmit_cpu()
210 	struct img_hash_dev *hdev = (struct img_hash_dev *)data;  in img_hash_dma_callback()  local
211 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_dma_callback()
214 		img_hash_xmit_cpu(hdev, ctx->buffer, ctx->bufcnt, 0);  in img_hash_dma_callback()
218 		tasklet_schedule(&hdev->dma_task);  in img_hash_dma_callback()
221 static int img_hash_xmit_dma(struct img_hash_dev *hdev, struct scatterlist *sg)  in img_hash_xmit_dma()  argument
224 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_xmit_dma()
226 	ctx->dma_ct = dma_map_sg(hdev->dev, sg, 1, DMA_MEM_TO_DEV);  in img_hash_xmit_dma()
228 		dev_err(hdev->dev, "Invalid DMA sg\n");  in img_hash_xmit_dma()
229 		hdev->err = -EINVAL;  in img_hash_xmit_dma()
233 	desc = dmaengine_prep_slave_sg(hdev->dma_lch,  in img_hash_xmit_dma()
239 		dev_err(hdev->dev, "Null DMA descriptor\n");  in img_hash_xmit_dma()
240 		hdev->err = -EINVAL;  in img_hash_xmit_dma()
241 		dma_unmap_sg(hdev->dev, sg, 1, DMA_MEM_TO_DEV);  in img_hash_xmit_dma()
245 	desc->callback_param = hdev;  in img_hash_xmit_dma()
247 	dma_async_issue_pending(hdev->dma_lch);  in img_hash_xmit_dma()
252 static int img_hash_write_via_cpu(struct img_hash_dev *hdev)  in img_hash_write_via_cpu()  argument
254 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_write_via_cpu()
256 	ctx->bufcnt = sg_copy_to_buffer(hdev->req->src, sg_nents(ctx->sg),  in img_hash_write_via_cpu()
257 					ctx->buffer, hdev->req->nbytes);  in img_hash_write_via_cpu()
259 	ctx->total = hdev->req->nbytes;  in img_hash_write_via_cpu()
262 	hdev->flags |= (DRIVER_FLAGS_CPU | DRIVER_FLAGS_FINAL);  in img_hash_write_via_cpu()
264 	img_hash_start(hdev, false);  in img_hash_write_via_cpu()
266 	return img_hash_xmit_cpu(hdev, ctx->buffer, ctx->total, 1);  in img_hash_write_via_cpu()
288 		hash[i] = img_hash_read_result_queue(ctx->hdev);  in img_hash_copy_hash()
294 	struct img_hash_dev *hdev =  ctx->hdev;  in img_hash_finish_req()  local
298 		if (DRIVER_FLAGS_FINAL & hdev->flags)  in img_hash_finish_req()
301 		dev_warn(hdev->dev, "Hash failed with error %d\n", err);  in img_hash_finish_req()
305 	hdev->flags &= ~(DRIVER_FLAGS_DMA_READY | DRIVER_FLAGS_OUTPUT_READY |  in img_hash_finish_req()
312 static int img_hash_write_via_dma(struct img_hash_dev *hdev)  in img_hash_write_via_dma()  argument
314 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_write_via_dma()
316 	img_hash_start(hdev, true);  in img_hash_write_via_dma()
318 	dev_dbg(hdev->dev, "xmit dma size: %d\n", ctx->total);  in img_hash_write_via_dma()
321 		hdev->flags |= DRIVER_FLAGS_FINAL;  in img_hash_write_via_dma()
323 	hdev->flags |= DRIVER_FLAGS_DMA_ACTIVE | DRIVER_FLAGS_FINAL;  in img_hash_write_via_dma()
325 	tasklet_schedule(&hdev->dma_task);  in img_hash_write_via_dma()
330 static int img_hash_dma_init(struct img_hash_dev *hdev)  in img_hash_dma_init()  argument
335 	hdev->dma_lch = dma_request_slave_channel(hdev->dev, "tx");  in img_hash_dma_init()
336 	if (!hdev->dma_lch) {  in img_hash_dma_init()
337 		dev_err(hdev->dev, "Couldn't aquire a slave DMA channel.\n");  in img_hash_dma_init()
341 	dma_conf.dst_addr = hdev->bus_addr;  in img_hash_dma_init()
346 	err = dmaengine_slave_config(hdev->dma_lch,  &dma_conf);  in img_hash_dma_init()
348 		dev_err(hdev->dev, "Couldn't configure DMA slave.\n");  in img_hash_dma_init()
349 		dma_release_channel(hdev->dma_lch);  in img_hash_dma_init()
358 	struct img_hash_dev *hdev = (struct img_hash_dev *)d;  in img_hash_dma_task()  local
359 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_dma_task()
385 		if (img_hash_xmit_dma(hdev, &tsg)) {  in img_hash_dma_task()
386 			dev_err(hdev->dev, "DMA failed, falling back to CPU");  in img_hash_dma_task()
388 			hdev->err = 0;  in img_hash_dma_task()
389 			img_hash_xmit_cpu(hdev, addr + ctx->offset,  in img_hash_dma_task()
421 			img_hash_dma_callback(hdev);  in img_hash_dma_task()
428 static int img_hash_write_via_dma_stop(struct img_hash_dev *hdev)  in img_hash_write_via_dma_stop()  argument
430 	struct img_hash_request_ctx *ctx = ahash_request_ctx(hdev->req);  in img_hash_write_via_dma_stop()
433 		dma_unmap_sg(hdev->dev, ctx->sg, ctx->dma_ct, DMA_TO_DEVICE);  in img_hash_write_via_dma_stop()
438 static int img_hash_process_data(struct img_hash_dev *hdev)  in img_hash_process_data()  argument
440 	struct ahash_request *req = hdev->req;  in img_hash_process_data()
447 		dev_dbg(hdev->dev, "process data request(%d bytes) using DMA\n",  in img_hash_process_data()
449 		err = img_hash_write_via_dma(hdev);  in img_hash_process_data()
451 		dev_dbg(hdev->dev, "process data request(%d bytes) using CPU\n",  in img_hash_process_data()
453 		err = img_hash_write_via_cpu(hdev);  in img_hash_process_data()
458 static int img_hash_hw_init(struct img_hash_dev *hdev)  in img_hash_hw_init()  argument
463 	img_hash_write(hdev, CR_RESET, CR_RESET_SET);  in img_hash_hw_init()
464 	img_hash_write(hdev, CR_RESET, CR_RESET_UNSET);  in img_hash_hw_init()
465 	img_hash_write(hdev, CR_INTENAB, CR_INT_NEW_RESULTS_SET);  in img_hash_hw_init()
467 	nbits = (u64)hdev->req->nbytes << 3;  in img_hash_hw_init()
470 	img_hash_write(hdev, CR_MESSAGE_LENGTH_H, u);  in img_hash_hw_init()
471 	img_hash_write(hdev, CR_MESSAGE_LENGTH_L, l);  in img_hash_hw_init()
473 	if (!(DRIVER_FLAGS_INIT & hdev->flags)) {  in img_hash_hw_init()
474 		hdev->flags |= DRIVER_FLAGS_INIT;  in img_hash_hw_init()
475 		hdev->err = 0;  in img_hash_hw_init()
477 	dev_dbg(hdev->dev, "hw initialized, nbits: %llx\n", nbits);  in img_hash_hw_init()
494 static int img_hash_handle_queue(struct img_hash_dev *hdev,  in img_hash_handle_queue()  argument
502 	spin_lock_irqsave(&hdev->lock, flags);  in img_hash_handle_queue()
505 		res = ahash_enqueue_request(&hdev->queue, req);  in img_hash_handle_queue()
507 	if (DRIVER_FLAGS_BUSY & hdev->flags) {  in img_hash_handle_queue()
508 		spin_unlock_irqrestore(&hdev->lock, flags);  in img_hash_handle_queue()
512 	backlog = crypto_get_backlog(&hdev->queue);  in img_hash_handle_queue()
513 	async_req = crypto_dequeue_request(&hdev->queue);  in img_hash_handle_queue()
515 		hdev->flags |= DRIVER_FLAGS_BUSY;  in img_hash_handle_queue()
517 	spin_unlock_irqrestore(&hdev->lock, flags);  in img_hash_handle_queue()
526 	hdev->req = req;  in img_hash_handle_queue()
530 	dev_info(hdev->dev, "processing req, op: %lu, bytes: %d\n",  in img_hash_handle_queue()
533 	err = img_hash_hw_init(hdev);  in img_hash_handle_queue()
536 		err = img_hash_process_data(hdev);  in img_hash_handle_queue()
595 	struct img_hash_dev *hdev = NULL;  in img_hash_digest()  local
600 	if (!tctx->hdev) {  in img_hash_digest()
602 			hdev = tmp;  in img_hash_digest()
605 		tctx->hdev = hdev;  in img_hash_digest()
608 		hdev = tctx->hdev;  in img_hash_digest()
612 	ctx->hdev = hdev;  in img_hash_digest()
641 	err = img_hash_handle_queue(tctx->hdev, req);  in img_hash_digest()
678 	struct img_hash_dev *hdev = dev_id;  in img_irq_handler()  local
681 	reg = img_hash_read(hdev, CR_INTSTAT);  in img_irq_handler()
682 	img_hash_write(hdev, CR_INTCLEAR, reg);  in img_irq_handler()
685 		dev_dbg(hdev->dev, "IRQ CR_INT_NEW_RESULTS_SET\n");  in img_irq_handler()
686 		if (DRIVER_FLAGS_BUSY & hdev->flags) {  in img_irq_handler()
687 			hdev->flags |= DRIVER_FLAGS_OUTPUT_READY;  in img_irq_handler()
688 			if (!(DRIVER_FLAGS_CPU & hdev->flags))  in img_irq_handler()
689 				hdev->flags |= DRIVER_FLAGS_DMA_READY;  in img_irq_handler()
690 			tasklet_schedule(&hdev->done_task);  in img_irq_handler()
692 			dev_warn(hdev->dev,  in img_irq_handler()
696 		dev_warn(hdev->dev,  in img_irq_handler()
699 		dev_warn(hdev->dev,  in img_irq_handler()
702 		dev_warn(hdev->dev,  in img_irq_handler()
803 static int img_register_algs(struct img_hash_dev *hdev)  in img_register_algs()  argument
821 static int img_unregister_algs(struct img_hash_dev *hdev)  in img_unregister_algs()  argument
832 	struct img_hash_dev *hdev = (struct img_hash_dev *)data;  in img_hash_done_task()  local
835 	if (hdev->err == -EINVAL) {  in img_hash_done_task()
836 		err = hdev->err;  in img_hash_done_task()
840 	if (!(DRIVER_FLAGS_BUSY & hdev->flags)) {  in img_hash_done_task()
841 		img_hash_handle_queue(hdev, NULL);  in img_hash_done_task()
845 	if (DRIVER_FLAGS_CPU & hdev->flags) {  in img_hash_done_task()
846 		if (DRIVER_FLAGS_OUTPUT_READY & hdev->flags) {  in img_hash_done_task()
847 			hdev->flags &= ~DRIVER_FLAGS_OUTPUT_READY;  in img_hash_done_task()
850 	} else if (DRIVER_FLAGS_DMA_READY & hdev->flags) {  in img_hash_done_task()
851 		if (DRIVER_FLAGS_DMA_ACTIVE & hdev->flags) {  in img_hash_done_task()
852 			hdev->flags &= ~DRIVER_FLAGS_DMA_ACTIVE;  in img_hash_done_task()
853 			img_hash_write_via_dma_stop(hdev);  in img_hash_done_task()
854 			if (hdev->err) {  in img_hash_done_task()
855 				err = hdev->err;  in img_hash_done_task()
859 		if (DRIVER_FLAGS_OUTPUT_READY & hdev->flags) {  in img_hash_done_task()
860 			hdev->flags &= ~(DRIVER_FLAGS_DMA_READY |  in img_hash_done_task()
868 	img_hash_finish_req(hdev->req, err);  in img_hash_done_task()
879 	struct img_hash_dev *hdev;  in img_hash_probe()  local
885 	hdev = devm_kzalloc(dev, sizeof(*hdev), GFP_KERNEL);  in img_hash_probe()
886 	if (hdev == NULL)  in img_hash_probe()
889 	spin_lock_init(&hdev->lock);  in img_hash_probe()
891 	hdev->dev = dev;  in img_hash_probe()
893 	platform_set_drvdata(pdev, hdev);  in img_hash_probe()
895 	INIT_LIST_HEAD(&hdev->list);  in img_hash_probe()
897 	tasklet_init(&hdev->done_task, img_hash_done_task, (unsigned long)hdev);  in img_hash_probe()
898 	tasklet_init(&hdev->dma_task, img_hash_dma_task, (unsigned long)hdev);  in img_hash_probe()
900 	crypto_init_queue(&hdev->queue, IMG_HASH_QUEUE_LENGTH);  in img_hash_probe()
905 	hdev->io_base = devm_ioremap_resource(dev, hash_res);  in img_hash_probe()
906 	if (IS_ERR(hdev->io_base)) {  in img_hash_probe()
907 		err = PTR_ERR(hdev->io_base);  in img_hash_probe()
915 	hdev->cpu_addr = devm_ioremap_resource(dev, hash_res);  in img_hash_probe()
916 	if (IS_ERR(hdev->cpu_addr)) {  in img_hash_probe()
918 		err = PTR_ERR(hdev->cpu_addr);  in img_hash_probe()
921 	hdev->bus_addr = hash_res->start;  in img_hash_probe()
931 			       dev_name(dev), hdev);  in img_hash_probe()
938 	hdev->hash_clk = devm_clk_get(&pdev->dev, "hash");  in img_hash_probe()
939 	if (IS_ERR(hdev->hash_clk)) {  in img_hash_probe()
941 		err = PTR_ERR(hdev->hash_clk);  in img_hash_probe()
945 	hdev->sys_clk = devm_clk_get(&pdev->dev, "sys");  in img_hash_probe()
946 	if (IS_ERR(hdev->sys_clk)) {  in img_hash_probe()
948 		err = PTR_ERR(hdev->sys_clk);  in img_hash_probe()
952 	err = clk_prepare_enable(hdev->hash_clk);  in img_hash_probe()
956 	err = clk_prepare_enable(hdev->sys_clk);  in img_hash_probe()
960 	err = img_hash_dma_init(hdev);  in img_hash_probe()
965 		dma_chan_name(hdev->dma_lch));  in img_hash_probe()
968 	list_add_tail(&hdev->list, &img_hash.dev_list);  in img_hash_probe()
971 	err = img_register_algs(hdev);  in img_hash_probe()
980 	list_del(&hdev->list);  in img_hash_probe()
982 	dma_release_channel(hdev->dma_lch);  in img_hash_probe()
984 	clk_disable_unprepare(hdev->sys_clk);  in img_hash_probe()
986 	clk_disable_unprepare(hdev->hash_clk);  in img_hash_probe()
988 	tasklet_kill(&hdev->done_task);  in img_hash_probe()
989 	tasklet_kill(&hdev->dma_task);  in img_hash_probe()
996 	static struct img_hash_dev *hdev;  in img_hash_remove()  local
998 	hdev = platform_get_drvdata(pdev);  in img_hash_remove()
1000 	list_del(&hdev->list);  in img_hash_remove()
1003 	img_unregister_algs(hdev);  in img_hash_remove()
1005 	tasklet_kill(&hdev->done_task);  in img_hash_remove()
1006 	tasklet_kill(&hdev->dma_task);  in img_hash_remove()
1008 	dma_release_channel(hdev->dma_lch);  in img_hash_remove()
1010 	clk_disable_unprepare(hdev->hash_clk);  in img_hash_remove()
1011 	clk_disable_unprepare(hdev->sys_clk);  in img_hash_remove()