From 1fef799b9da8b2a0875f7be4f88e830d5282cc0f Mon Sep 17 00:00:00 2001
From: Xuhua Zhang <xuhua.zhang@amlogic.com>
Date: Thu, 13 Dec 2018 16:41:49 +0800
Subject: [PATCH] tvin: vdin: vdin add afbce write back to memory interface
 [1/1]

PD#SWPL-3200

Problem:
vdin add afbce need more debug method.

Solution:
vdin add read_pic_afbce debug interface

Verify:
TL1 X301

Change-Id: I45a741ba20409dc25b41ce316b0df0dce9d2dc28
Signed-off-by: Xuhua Zhang <xuhua.zhang@amlogic.com>
---
 drivers/amlogic/media/vin/tvin/vdin/vdin_debug.c | 92 ++++++++++++++++++++++++
 1 file changed, 92 insertions(+)

diff --git a/drivers/amlogic/media/vin/tvin/vdin/vdin_debug.c b/drivers/amlogic/media/vin/tvin/vdin/vdin_debug.c
index 051a874..a6c0393 100644
--- a/drivers/amlogic/media/vin/tvin/vdin/vdin_debug.c
+++ b/drivers/amlogic/media/vin/tvin/vdin/vdin_debug.c
@@ -1097,6 +1097,93 @@ static void vdin_dump_histgram(struct vdin_dev_s *devp)
 	}
 }
 
+/*type: 1:nv21 2:yuv422 3:yuv444*/
+static void vdin_write_afbce_mem(struct vdin_dev_s *devp, char *type)
+{
+	char *md_path_head = "/storage/B8F7-DBD0/afbce/a0_1header.bin";
+	char *md_path_body = "/storage/B8F7-DBD0/afbce/a0_1body.bin";
+	unsigned int i;
+	unsigned int size = 0;
+	long val;
+	struct file *filp = NULL;
+	loff_t pos = 0;
+	mm_segment_t old_fs;
+	void *head_dts = NULL;
+	void *body_dts = NULL;
+
+	if (kstrtol(type, 10, &val) < 0)
+		return;
+
+	if (!devp->curr_wr_vfe) {
+		devp->curr_wr_vfe = provider_vf_get(devp->vfp);
+		if (!devp->curr_wr_vfe) {
+			pr_info("no buffer to write.\n");
+			return;
+		}
+	}
+
+	i = devp->curr_wr_vfe->af_num;
+	devp->curr_wr_vfe->vf.type = VIDTYPE_VIU_SINGLE_PLANE |
+			VIDTYPE_VIU_FIELD | VIDTYPE_COMPRESS | VIDTYPE_SCATTER;
+	switch (val) {
+	case 1:
+		devp->curr_wr_vfe->vf.type |= VIDTYPE_VIU_NV21;
+		break;
+	case 2:
+		devp->curr_wr_vfe->vf.type |= VIDTYPE_VIU_422;
+		break;
+	case 3:
+		devp->curr_wr_vfe->vf.type |= VIDTYPE_VIU_444;
+		break;
+	default:
+		devp->curr_wr_vfe->vf.type |= VIDTYPE_VIU_422;
+		break;
+	}
+
+	devp->curr_wr_vfe->vf.compHeadAddr = devp->afbce_info->fm_head_paddr[i];
+	devp->curr_wr_vfe->vf.compBodyAddr = devp->afbce_info->fm_body_paddr[i];
+
+	head_dts = codec_mm_phys_to_virt(devp->afbce_info->fm_head_paddr[i]);
+	body_dts = codec_mm_phys_to_virt(devp->afbce_info->fm_body_paddr[i]);
+
+	old_fs = get_fs();
+	set_fs(KERNEL_DS);
+	pr_info("head bin file path = %s\n", md_path_head);
+	filp = filp_open(md_path_head, O_RDONLY, 0);
+	if (IS_ERR(filp)) {
+		pr_info("read %s error.\n", md_path_head);
+		return;
+	}
+
+	size = vfs_read(filp, head_dts,
+		devp->afbce_info->frame_head_size, &pos);
+
+	vfs_fsync(filp, 0);
+	filp_close(filp, NULL);
+	set_fs(old_fs);
+
+	pos = 0;
+	old_fs = get_fs();
+	set_fs(KERNEL_DS);
+	pr_info("body bin file path = %s\n", md_path_body);
+	filp = filp_open(md_path_body, O_RDONLY, 0);
+	if (IS_ERR(filp)) {
+		pr_info("read %s error.\n", md_path_body);
+		return;
+	}
+
+	size = vfs_read(filp, body_dts,
+		devp->afbce_info->frame_body_size, &pos);
+
+	vfs_fsync(filp, 0);
+	filp_close(filp, NULL);
+	set_fs(old_fs);
+
+	provider_vf_put(devp->curr_wr_vfe, devp->vfp);
+	devp->curr_wr_vfe = NULL;
+	vf_notify_receiver(devp->name, VFRAME_EVENT_PROVIDER_VFRAME_READY,
+			NULL);
+}
 static void vdin_write_mem(
 	struct vdin_dev_s *devp, char *type,
 	char *path, char *md_path)
@@ -1699,6 +1786,11 @@ start_chk:
 #endif
 	} else if (!strcmp(parm[0], "force_recycle")) {
 		devp->flags |= VDIN_FLAG_FORCE_RECYCLE;
+	} else if (!strcmp(parm[0], "read_pic_afbce")) {
+		if (parm[1])
+			vdin_write_afbce_mem(devp, parm[1]);
+		else
+			pr_err("miss parameters.\n");
 	} else if (!strcmp(parm[0], "read_pic")) {
 		if (parm[1] && parm[2])
 			vdin_write_mem(devp, parm[1], parm[2], parm[3]);
-- 
2.7.4