vdin: add vdin1 histgram [1/1]

PD#SWPL-3059

Problem:
vdin1 hisgram and screencap cannot be used simultaneously

Solution:
add vdin1 histgram,and make hist and screencap function to be compatible

Verify:
txlx r311

Change-Id: I759d1cdc69d59015ce845898990088eb6943cc41
Signed-off-by: xuhua zhang <xuhua.zhang@amlogic.com>

drivers/amlogic/media/video_processor/video_dev/amlvideo2.c

@@ -5054,6 +5054,7 @@ static int vidioc_streamon(struct file *file, void *priv, enum v4l2_buf_type i)
 	}
 	para.dest_hactive = dst_w;
 	para.dest_vactive = dst_h;
+	para.reserved |= PARAM_STATE_SCREENCAP;
 	if (para.scan_mode == TVIN_SCAN_MODE_INTERLACED)
 		para.dest_vactive = para.dest_vactive / 2;
 	if (para.port == TVIN_PORT_VIU1_VIDEO) {

drivers/amlogic/media/vin/tvin/vdin/vdin_ctl.c

@@ -1760,7 +1760,13 @@ static inline void vdin_set_hist_mux(struct vdin_dev_s *devp)
 	/* use 11: form matrix1 din */
 	wr_bits(devp->addr_offset, VDIN_HIST_CTRL, 3,
 			HIST_HIST_DIN_SEL_BIT, HIST_HIST_DIN_SEL_WID);
+
+	/*for project get vdin1 hist*/
+	//if (devp->index == 1)
+	//	wr_bits(devp->addr_offset, VDIN_WR_CTRL2, 1, 8, 1);
 }
+
+
 /* urgent ctr config */
 /*if vdin fifo over up_th,will trigger increase
  * urgent responds to vdin write,

drivers/amlogic/media/vin/tvin/vdin/vdin_drv.c

@@ -80,6 +80,7 @@ static unsigned long mem_start, mem_end;
 static unsigned int use_reserved_mem;
 static int afbc_init_flag;
 static int afbc_write_down_flag;
+static unsigned int pr_times;
 /*
  * canvas_config_mode
  * 0: canvas_config in driver probe
@@ -141,6 +142,8 @@ static unsigned int vdin_drop_cnt;
 module_param(vdin_drop_cnt, uint, 0664);
 MODULE_PARM_DESC(vdin_drop_cnt, "vdin_drop_cnt");
 
+struct vdin_hist_s vdin1_hist;
+struct vdin_v4l2_param_s vdin_v4l2_param;
 
 static int irq_max_count;
 
@@ -747,17 +750,31 @@ int start_tvin_service(int no, struct vdin_parm_s  *para)
 		pr_info("v_active:%d;scan_mode:%d**\n",
 				para->v_active, para->scan_mode);
 	}
+
+	if (devp->index == 1) {
+		devp->parm.reserved |= para->reserved;
+		pr_info("vdin1 add reserved = 0x%lx\n", para->reserved);
+		pr_info("vdin1 all reserved = 0x%x\n", devp->parm.reserved);
+	}
 	devp->start_time = jiffies_to_msecs(jiffies);
 	if (devp->flags & VDIN_FLAG_DEC_STARTED) {
 		pr_err("%s: port 0x%x, decode started already.\n",
 				__func__, para->port);
-		ret = -EBUSY;
-		return ret;
+		if ((devp->parm.reserved & PARAM_STATE_SCREENCAP) &&
+			(devp->parm.reserved & PARAM_STATE_HISTGRAM) &&
+			(devp->index == 1))
+			return 0;
+		else
+			return -EBUSY;
 	}
 	if ((para->port != TVIN_PORT_VIU1) ||
 		(viu_hw_irq != 0)) {
 		ret = request_irq(devp->irq, vdin_v4l2_isr, IRQF_SHARED,
 				devp->irq_name, (void *)devp);
+		if (ret != 0) {
+			pr_info("vdin_v4l2_isr request irq error.\n");
+			return -1;
+		}
 		devp->flags |= VDIN_FLAG_ISR_REQ;
 		/*disable vsync irq until vdin configured completely*/
 		disable_irq_nosync(devp->irq);
@@ -858,6 +875,14 @@ int stop_tvin_service(int no)
 	unsigned int end_time;
 
 	devp = vdin_devp[no];
+	if ((devp->parm.reserved & PARAM_STATE_HISTGRAM) &&
+		(devp->parm.reserved & PARAM_STATE_SCREENCAP) &&
+		(devp->index == 1)) {
+		pr_info("stop vdin v4l2 screencap.\n");
+		devp->parm.reserved &= ~PARAM_STATE_SCREENCAP;
+		return 0;
+	}
+
 	if (!(devp->flags&VDIN_FLAG_DEC_STARTED)) {
 		pr_err("%s:decode hasn't started.\n", __func__);
 		return -EBUSY;
@@ -1213,7 +1238,34 @@ static u64 func_div(u64 cur, u32 divid)
 	return cur;
 }
 
+static void vdin_hist_tgt(struct vdin_dev_s *devp, struct vframe_s *vf)
+{
+	int ave_luma;
+	int pix_sum;
+	ulong flags;
 
+	spin_lock_irqsave(&devp->hist_lock, flags);
+	vdin1_hist.sum    = vf->prop.hist.luma_sum;
+	pix_sum = vf->prop.hist.pixel_sum;
+	vdin1_hist.height = vf->prop.hist.height;
+	vdin1_hist.width =  vf->prop.hist.width;
+
+	if ((vdin1_hist.height == 0) || (vdin1_hist.width == 0)) {
+		spin_unlock_irqrestore(&devp->hist_lock, flags);
+		return;
+	}
+
+	vdin1_hist.ave =
+		vdin1_hist.sum/(vdin1_hist.height * vdin1_hist.width);
+
+	ave_luma = vdin1_hist.ave;
+	ave_luma = (ave_luma - 16) < 0 ? 0 : (ave_luma - 16);
+	vdin1_hist.ave = ave_luma*255/(235-16);
+	if (vdin1_hist.ave > 255)
+		vdin1_hist.ave = 255;
+
+	spin_unlock_irqrestore(&devp->hist_lock, flags);
+}
 
 /*
  *VDIN_FLAG_RDMA_ENABLE=1
@@ -1757,6 +1809,7 @@ irqreturn_t vdin_v4l2_isr(int irq, void *dev_id)
 
 	vdin_set_vframe_prop_info(curr_wr_vf, devp);
 	vdin_backup_histgram(curr_wr_vf, devp);
+	vdin_hist_tgt(devp, curr_wr_vf);
 
 	if (devp->frontend && devp->frontend->dec_ops) {
 		decops = devp->frontend->dec_ops;
@@ -1999,6 +2052,9 @@ static long vdin_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
 	int callmaster_status = 0;
 	struct vdin_dev_s *devp = NULL;
 	void __user *argp = (void __user *)arg;
+	struct vdin_parm_s param;
+	ulong flags;
+	struct vdin_hist_s vdin1_hist_temp;
 
 	/* Get the per-device structure that contains this cdev */
 	devp = file->private_data;
@@ -2385,6 +2441,84 @@ static long vdin_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
 			devp->prop.latency.cn_type);
 		mutex_unlock(&devp->fe_lock);
 		break;
+	case TVIN_IOC_G_VDIN_HIST:
+		if (devp->index == 0) {
+			pr_info("TVIN_IOC_G_VDIN_HIST cann't be used at vdin0\n");
+			break;
+		}
+
+		spin_lock_irqsave(&devp->hist_lock, flags);
+		vdin1_hist_temp.sum = vdin1_hist.sum;
+		vdin1_hist_temp.width = vdin1_hist.width;
+		vdin1_hist_temp.height = vdin1_hist.height;
+		vdin1_hist_temp.ave = vdin1_hist.ave;
+		spin_unlock_irqrestore(&devp->hist_lock, flags);
+		if (vdin_dbg_en) {
+			if (pr_times++ > 10) {
+				pr_times = 0;
+				pr_info("-:h=%d,w=%d,a=%d\n",
+					vdin1_hist_temp.height,
+					vdin1_hist_temp.width,
+					vdin1_hist_temp.ave);
+			}
+		}
+
+		if ((vdin1_hist.height == 0) || (vdin1_hist.width == 0))
+			ret = -EFAULT;
+		else if (copy_to_user(argp,
+				&vdin1_hist_temp,
+				sizeof(struct vdin_hist_s))) {
+			pr_info("vdin1_hist copy fail\n");
+			ret = -EFAULT;
+		}
+		break;
+	case TVIN_IOC_S_VDIN_V4L2START:
+		if (devp->index == 0) {
+			pr_info("TVIN_IOC_S_VDIN_V4L2START cann't be used at vdin0\n");
+			break;
+		}
+		if (devp->flags & VDIN_FLAG_ISR_REQ)
+			free_irq(devp->irq, (void *)devp);
+
+		if (copy_from_user(&vdin_v4l2_param, argp,
+				sizeof(struct vdin_v4l2_param_s))) {
+			pr_info("vdin_v4l2_param copy fail\n");
+			return -EFAULT;
+		}
+		memset(&param, 0, sizeof(struct vdin_parm_s));
+		param.port = TVIN_PORT_VIU1;
+		param.reserved |= PARAM_STATE_HISTGRAM;
+		param.h_active = vdin_v4l2_param.width;
+		param.v_active = vdin_v4l2_param.height;
+		/* use 1280X720 for histgram*/
+		if ((vdin_v4l2_param.width > 1280) &&
+			(vdin_v4l2_param.height > 720)) {
+			devp->debug.scaler4w = 1280;
+			devp->debug.scaler4h = 720;
+			devp->debug.dest_cfmt = TVIN_YUV422;
+			devp->flags |= VDIN_FLAG_MANUAL_CONVERSION;
+		}
+		param.frame_rate = vdin_v4l2_param.fps;
+		param.cfmt = TVIN_YUV422;
+		param.dfmt = TVIN_YUV422;
+		param.scan_mode = TVIN_SCAN_MODE_PROGRESSIVE;
+		param.fmt = TVIN_SIG_FMT_MAX;
+		//devp->flags |= VDIN_FLAG_V4L2_DEBUG;
+		devp->hist_bar_enable = 1;
+		devp->index = 1;
+		start_tvin_service(devp->index, &param);
+		break;
+
+	case TVIN_IOC_S_VDIN_V4L2STOP:
+		if (devp->index == 0) {
+			pr_info("TVIN_IOC_S_VDIN_V4L2STOP cann't be used at vdin0\n");
+			break;
+		}
+		devp->parm.reserved &= ~PARAM_STATE_HISTGRAM;
+		devp->flags &= (~VDIN_FLAG_ISR_REQ);
+		devp->flags &= (~VDIN_FLAG_FS_OPENED);
+		stop_tvin_service(devp->index);
+		break;
 	default:
 		ret = -ENOIOCTLCMD;
 	/* pr_info("%s %d is not supported command\n", __func__, cmd); */
@@ -2665,6 +2799,7 @@ static int vdin_drv_probe(struct platform_device *pdev)
 	vdevp->flags &= (~VDIN_FLAG_FS_OPENED);
 	mutex_init(&vdevp->fe_lock);
 	spin_lock_init(&vdevp->isr_lock);
+	spin_lock_init(&vdevp->hist_lock);
 	vdevp->frontend = NULL;
 
 	/* @todo vdin_addr_offset */

drivers/amlogic/media/vin/tvin/vdin/vdin_drv.h

@@ -205,6 +205,7 @@ struct vdin_dev_s {
 
 	struct timer_list timer;
 	spinlock_t isr_lock;
+	spinlock_t hist_lock;
 	struct mutex fe_lock;
 	struct clk *msr_clk;
 	unsigned int msr_clk_val;
@@ -349,6 +350,19 @@ struct vdin_dev_s {
 	struct dentry *dbg_root;	/*dbg_fs*/
 };
 
+struct vdin_hist_s {
+	ulong sum;
+	int width;
+	int height;
+	int ave;
+};
+
+struct vdin_v4l2_param_s {
+	int width;
+	int height;
+	int fps;
+};
+
 extern struct vframe_provider_s *vf_get_provider_by_name(
 		const char *provider_name);
 extern bool enable_reset;

include/linux/amlogic/media/frame_provider/tvin/tvin.h

@@ -451,6 +451,9 @@ struct tvafe_pin_mux_s {
 #define TVIN_IOC_LOAD_REG          _IOW(_TM_T, 0x20, struct am_regs_s)
 #define TVIN_IOC_S_AFE_SONWON     _IO(_TM_T, 0x22)
 #define TVIN_IOC_S_AFE_SONWOFF     _IO(_TM_T, 0x23)
+#define TVIN_IOC_G_VDIN_HIST       _IOW(_TM_T, 0x24, struct vdin_hist_s)
+#define TVIN_IOC_S_VDIN_V4L2START  _IOW(_TM_T, 0x25, struct vdin_v4l2_param_s)
+#define TVIN_IOC_S_VDIN_V4L2STOP   _IO(_TM_T, 0x26)
 
 /*
  *function defined applied for other driver

include/linux/amlogic/media/frame_provider/tvin/tvin_v4l2.h

@@ -742,6 +742,10 @@ enum cam_interface_e {
 	CAM_MIPI,
 };
 
+#define PARAM_STATE_NULL			0x00000000
+#define PARAM_STATE_HISTGRAM		0x00000001
+#define PARAM_STATE_SCREENCAP		0x00000002
+
 /* *********************************************************************** */
 
 /* *** IOCTL command definitions ***************************************** */
@@ -813,6 +817,7 @@ struct vdin_parm_s {
 	unsigned short skip_count;	/* for skip frame */
 
 	struct csi_parm_s csi_hw_info;
+
 	/*for reserved */
 	uintptr_t reserved;
 };