219 static inline void reg_write(struct sta2x11_vip *vip, unsigned int reg, u32 val)  in reg_write()  argument
221 	iowrite32((val), (vip->iomem)+(reg));  in reg_write()
224 static inline u32 reg_read(struct sta2x11_vip *vip, unsigned int reg)  in reg_read()  argument
226 	return  ioread32((vip->iomem)+(reg));  in reg_read()
229 static void start_dma(struct sta2x11_vip *vip, struct vip_buffer *vip_buf)  in start_dma()  argument
233 	if (vip->format.field == V4L2_FIELD_INTERLACED)  in start_dma()
234 		offset = vip->format.width * 2;  in start_dma()
236 	spin_lock_irq(&vip->slock);  in start_dma()
238 	reg_write(vip, DVP_CTL, reg_read(vip, DVP_CTL) | DVP_CTL_ENA);  in start_dma()
240 	reg_write(vip, DVP_VTP, (u32)vip_buf->dma);  in start_dma()
241 	reg_write(vip, DVP_VBP, (u32)vip_buf->dma + offset);  in start_dma()
242 	spin_unlock_irq(&vip->slock);  in start_dma()
246 static void vip_active_buf_next(struct sta2x11_vip *vip)  in vip_active_buf_next()  argument
249 	spin_lock(&vip->lock);  in vip_active_buf_next()
250 	if (list_empty(&vip->buffer_list)) {/* No available buffer */  in vip_active_buf_next()
251 		spin_unlock(&vip->lock);  in vip_active_buf_next()
254 	vip->active = list_first_entry(&vip->buffer_list,  in vip_active_buf_next()
258 	vip->tcount = 0;  in vip_active_buf_next()
259 	vip->bcount = 0;  in vip_active_buf_next()
260 	spin_unlock(&vip->lock);  in vip_active_buf_next()
261 	if (vb2_is_streaming(&vip->vb_vidq)) {	/* streaming is on */  in vip_active_buf_next()
262 		start_dma(vip, vip->active);	/* start dma capture */  in vip_active_buf_next()
272 	struct sta2x11_vip *vip = vb2_get_drv_priv(vq);  in queue_setup()  local
278 	sizes[0] = vip->format.sizeimage;  in queue_setup()
279 	alloc_ctxs[0] = vip->alloc_ctx;  in queue_setup()
281 	vip->sequence = 0;  in queue_setup()
282 	vip->active = NULL;  in queue_setup()
283 	vip->tcount = 0;  in queue_setup()
284 	vip->bcount = 0;  in queue_setup()
299 	struct sta2x11_vip *vip = vb2_get_drv_priv(vb->vb2_queue);  in buffer_prepare()  local
303 	size = vip->format.sizeimage;  in buffer_prepare()
305 		v4l2_err(&vip->v4l2_dev, "buffer too small (%lu < %lu)\n",  in buffer_prepare()
316 	struct sta2x11_vip *vip = vb2_get_drv_priv(vb->vb2_queue);  in buffer_queue()  local
319 	spin_lock(&vip->lock);  in buffer_queue()
320 	list_add_tail(&vip_buf->list, &vip->buffer_list);  in buffer_queue()
321 	if (!vip->active) {	/* No active buffer, active the first one */  in buffer_queue()
322 		vip->active = list_first_entry(&vip->buffer_list,  in buffer_queue()
325 		if (vb2_is_streaming(&vip->vb_vidq))	/* streaming is on */  in buffer_queue()
326 			start_dma(vip, vip_buf);	/* start dma capture */  in buffer_queue()
328 	spin_unlock(&vip->lock);  in buffer_queue()
332 	struct sta2x11_vip *vip = vb2_get_drv_priv(vb->vb2_queue);  in buffer_finish()  local
336 	spin_lock(&vip->lock);  in buffer_finish()
338 	spin_unlock(&vip->lock);  in buffer_finish()
341 		vip_active_buf_next(vip);  in buffer_finish()
346 	struct sta2x11_vip *vip = vb2_get_drv_priv(vq);  in start_streaming()  local
348 	spin_lock_irq(&vip->slock);  in start_streaming()
350 	reg_write(vip, DVP_ITM, DVP_IT_VSB | DVP_IT_VST);  in start_streaming()
351 	spin_unlock_irq(&vip->slock);  in start_streaming()
354 		start_dma(vip, vip->active);  in start_streaming()
362 	struct sta2x11_vip *vip = vb2_get_drv_priv(vq);  in stop_streaming()  local
366 	reg_write(vip, DVP_CTL, reg_read(vip, DVP_CTL) & ~DVP_CTL_ENA);  in stop_streaming()
368 	reg_write(vip, DVP_ITM, 0);  in stop_streaming()
371 	spin_lock(&vip->lock);  in stop_streaming()
372 	list_for_each_entry_safe(vip_buf, node, &vip->buffer_list, list) {  in stop_streaming()
376 	spin_unlock(&vip->lock);  in stop_streaming()
414 	struct sta2x11_vip *vip = video_drvdata(file);  in vidioc_querycap()  local
419 		 pci_name(vip->pdev));  in vidioc_querycap()
442 	struct sta2x11_vip *vip = video_drvdata(file);  in vidioc_s_std()  local
443 	v4l2_std_id oldstd = vip->std, newstd;  in vidioc_s_std()
447 		v4l2_subdev_call(vip->decoder, video, s_std, std);  in vidioc_s_std()
449 		v4l2_subdev_call(vip->decoder, video, querystd, &newstd);  in vidioc_s_std()
450 		v4l2_subdev_call(vip->decoder, video, g_input_status, &status);  in vidioc_s_std()
453 		std = vip->std = newstd;  in vidioc_s_std()
456 				vip->format = formats_60[0];  in vidioc_s_std()
458 				vip->format = formats_50[0];  in vidioc_s_std()
465 			vip->format = formats_60[0];  in vidioc_s_std()
467 			vip->format = formats_50[0];  in vidioc_s_std()
470 	return v4l2_subdev_call(vip->decoder, video, s_std, std);  in vidioc_s_std()
484 	struct sta2x11_vip *vip = video_drvdata(file);  in vidioc_g_std()  local
486 	*std = vip->std;  in vidioc_g_std()
501 	struct sta2x11_vip *vip = video_drvdata(file);  in vidioc_querystd()  local
503 	return v4l2_subdev_call(vip->decoder, video, querystd, std);  in vidioc_querystd()
532 	struct sta2x11_vip *vip = video_drvdata(file);  in vidioc_s_input()  local
537 	ret = v4l2_subdev_call(vip->decoder, video, s_routing, i, 0, 0);  in vidioc_s_input()
540 		vip->input = i;  in vidioc_s_input()
556 	struct sta2x11_vip *vip = video_drvdata(file);  in vidioc_g_input()  local
558 	*i = vip->input;  in vidioc_g_input()
602 	struct sta2x11_vip *vip = video_drvdata(file);  in vidioc_try_fmt_vid_cap()  local
606 		v4l2_warn(&vip->v4l2_dev, "Invalid format, only UYVY supported\n");  in vidioc_try_fmt_vid_cap()
610 	if (V4L2_STD_525_60 & vip->std)  in vidioc_try_fmt_vid_cap()
659 	struct sta2x11_vip *vip = video_drvdata(file);  in vidioc_s_fmt_vid_cap()  local
667 	if (vb2_is_busy(&vip->vb_vidq)) {  in vidioc_s_fmt_vid_cap()
669 		v4l2_err(&vip->v4l2_dev, "device busy\n");  in vidioc_s_fmt_vid_cap()
672 	vip->format = f->fmt.pix;  in vidioc_s_fmt_vid_cap()
673 	switch (vip->format.field) {  in vidioc_s_fmt_vid_cap()
675 		t_stop = ((vip->format.height / 2 - 1) << 16) |  in vidioc_s_fmt_vid_cap()
676 			 (2 * vip->format.width - 1);  in vidioc_s_fmt_vid_cap()
678 		pitch = 4 * vip->format.width;  in vidioc_s_fmt_vid_cap()
681 		t_stop = ((vip->format.height - 1) << 16) |  in vidioc_s_fmt_vid_cap()
682 			 (2 * vip->format.width - 1);  in vidioc_s_fmt_vid_cap()
683 		b_stop = (0 << 16) | (2 * vip->format.width - 1);  in vidioc_s_fmt_vid_cap()
684 		pitch = 2 * vip->format.width;  in vidioc_s_fmt_vid_cap()
687 		t_stop = (0 << 16) | (2 * vip->format.width - 1);  in vidioc_s_fmt_vid_cap()
688 		b_stop = (vip->format.height << 16) |  in vidioc_s_fmt_vid_cap()
689 			 (2 * vip->format.width - 1);  in vidioc_s_fmt_vid_cap()
690 		pitch = 2 * vip->format.width;  in vidioc_s_fmt_vid_cap()
693 		v4l2_err(&vip->v4l2_dev, "unknown field format\n");  in vidioc_s_fmt_vid_cap()
697 	spin_lock_irq(&vip->slock);  in vidioc_s_fmt_vid_cap()
699 	reg_write(vip, DVP_TFO, 0);  in vidioc_s_fmt_vid_cap()
701 	reg_write(vip, DVP_BFO, 0);  in vidioc_s_fmt_vid_cap()
703 	reg_write(vip, DVP_TFS, t_stop);  in vidioc_s_fmt_vid_cap()
705 	reg_write(vip, DVP_BFS, b_stop);  in vidioc_s_fmt_vid_cap()
707 	reg_write(vip, DVP_VMP, pitch);  in vidioc_s_fmt_vid_cap()
708 	spin_unlock_irq(&vip->slock);  in vidioc_s_fmt_vid_cap()
725 	struct sta2x11_vip *vip = video_drvdata(file);  in vidioc_g_fmt_vid_cap()  local
727 	f->fmt.pix = vip->format;  in vidioc_g_fmt_vid_cap()
785 static irqreturn_t vip_irq(int irq, struct sta2x11_vip *vip)  in vip_irq()  argument
789 	status = reg_read(vip, DVP_ITS);  in vip_irq()
795 		if (vip->overflow++ > 5)  in vip_irq()
805 		if ((++vip->tcount) < 2)  in vip_irq()
808 		vip->bcount++;  in vip_irq()
812 	if (vip->active) { /* Acquisition is over on this buffer */  in vip_irq()
814 		reg_write(vip, DVP_CTL, reg_read(vip, DVP_CTL) & ~DVP_CTL_ENA);  in vip_irq()
816 		do_gettimeofday(&vip->active->vb.v4l2_buf.timestamp);  in vip_irq()
817 		vip->active->vb.v4l2_buf.sequence = vip->sequence++;  in vip_irq()
818 		vb2_buffer_done(&vip->active->vb, VB2_BUF_STATE_DONE);  in vip_irq()
824 static void sta2x11_vip_init_register(struct sta2x11_vip *vip)  in sta2x11_vip_init_register()  argument
827 	spin_lock_irq(&vip->slock);  in sta2x11_vip_init_register()
829 	reg_read(vip, DVP_ITS);  in sta2x11_vip_init_register()
831 	reg_write(vip, DVP_HLFLN, DVP_HLFLN_SD);  in sta2x11_vip_init_register()
833 	reg_write(vip, DVP_CTL, DVP_CTL_RST);  in sta2x11_vip_init_register()
835 	reg_write(vip, DVP_CTL, 0);  in sta2x11_vip_init_register()
836 	spin_unlock_irq(&vip->slock);  in sta2x11_vip_init_register()
838 static void sta2x11_vip_clear_register(struct sta2x11_vip *vip)  in sta2x11_vip_clear_register()  argument
840 	spin_lock_irq(&vip->slock);  in sta2x11_vip_clear_register()
842 	reg_write(vip, DVP_ITM, 0);  in sta2x11_vip_clear_register()
844 	reg_write(vip, DVP_CTL, DVP_CTL_RST);  in sta2x11_vip_clear_register()
846 	reg_write(vip, DVP_CTL, 0);  in sta2x11_vip_clear_register()
848 	reg_read(vip, DVP_ITS);  in sta2x11_vip_clear_register()
849 	spin_unlock_irq(&vip->slock);  in sta2x11_vip_clear_register()
851 static int sta2x11_vip_init_buffer(struct sta2x11_vip *vip)  in sta2x11_vip_init_buffer()  argument
855 	err = dma_set_coherent_mask(&vip->pdev->dev, DMA_BIT_MASK(29));  in sta2x11_vip_init_buffer()
857 		v4l2_err(&vip->v4l2_dev, "Cannot configure coherent mask");  in sta2x11_vip_init_buffer()
860 	memset(&vip->vb_vidq, 0, sizeof(struct vb2_queue));  in sta2x11_vip_init_buffer()
861 	vip->vb_vidq.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;  in sta2x11_vip_init_buffer()
862 	vip->vb_vidq.io_modes = VB2_MMAP | VB2_READ;  in sta2x11_vip_init_buffer()
863 	vip->vb_vidq.drv_priv = vip;  in sta2x11_vip_init_buffer()
864 	vip->vb_vidq.buf_struct_size = sizeof(struct vip_buffer);  in sta2x11_vip_init_buffer()
865 	vip->vb_vidq.ops = &vip_video_qops;  in sta2x11_vip_init_buffer()
866 	vip->vb_vidq.mem_ops = &vb2_dma_contig_memops;  in sta2x11_vip_init_buffer()
867 	err = vb2_queue_init(&vip->vb_vidq);  in sta2x11_vip_init_buffer()
870 	INIT_LIST_HEAD(&vip->buffer_list);  in sta2x11_vip_init_buffer()
871 	spin_lock_init(&vip->lock);  in sta2x11_vip_init_buffer()
874 	vip->alloc_ctx = vb2_dma_contig_init_ctx(&vip->pdev->dev);  in sta2x11_vip_init_buffer()
875 	if (IS_ERR(vip->alloc_ctx)) {  in sta2x11_vip_init_buffer()
876 		v4l2_err(&vip->v4l2_dev, "Can't allocate buffer context");  in sta2x11_vip_init_buffer()
877 		return PTR_ERR(vip->alloc_ctx);  in sta2x11_vip_init_buffer()
882 static void sta2x11_vip_release_buffer(struct sta2x11_vip *vip)  in sta2x11_vip_release_buffer()  argument
884 	vb2_dma_contig_cleanup_ctx(vip->alloc_ctx);  in sta2x11_vip_release_buffer()
886 static int sta2x11_vip_init_controls(struct sta2x11_vip *vip)  in sta2x11_vip_init_controls()  argument
892 	v4l2_ctrl_handler_init(&vip->ctrl_hdl, 0);  in sta2x11_vip_init_controls()
894 	vip->v4l2_dev.ctrl_handler = &vip->ctrl_hdl;  in sta2x11_vip_init_controls()
895 	if (vip->ctrl_hdl.error) {  in sta2x11_vip_init_controls()
896 		int err = vip->ctrl_hdl.error;  in sta2x11_vip_init_controls()
898 		v4l2_ctrl_handler_free(&vip->ctrl_hdl);  in sta2x11_vip_init_controls()
984 	struct sta2x11_vip *vip;  in sta2x11_vip_init_one()  local
1034 	vip = kzalloc(sizeof(struct sta2x11_vip), GFP_KERNEL);  in sta2x11_vip_init_one()
1035 	if (!vip) {  in sta2x11_vip_init_one()
1039 	vip->pdev = pdev;  in sta2x11_vip_init_one()
1040 	vip->std = V4L2_STD_PAL;  in sta2x11_vip_init_one()
1041 	vip->format = formats_50[0];  in sta2x11_vip_init_one()
1042 	vip->config = config;  in sta2x11_vip_init_one()
1044 	ret = sta2x11_vip_init_controls(vip);  in sta2x11_vip_init_one()
1047 	ret = v4l2_device_register(&pdev->dev, &vip->v4l2_dev);  in sta2x11_vip_init_one()
1061 	vip->iomem = pci_iomap(pdev, 0, 0x100);  in sta2x11_vip_init_one()
1062 	if (!vip->iomem) {  in sta2x11_vip_init_one()
1070 	ret = sta2x11_vip_init_buffer(vip);  in sta2x11_vip_init_one()
1074 	spin_lock_init(&vip->slock);  in sta2x11_vip_init_one()
1078 			  IRQF_SHARED, KBUILD_MODNAME, vip);  in sta2x11_vip_init_one()
1086 	vip->video_dev = video_dev_template;  in sta2x11_vip_init_one()
1087 	vip->video_dev.v4l2_dev = &vip->v4l2_dev;  in sta2x11_vip_init_one()
1088 	vip->video_dev.queue = &vip->vb_vidq;  in sta2x11_vip_init_one()
1089 	video_set_drvdata(&vip->video_dev, vip);  in sta2x11_vip_init_one()
1091 	ret = video_register_device(&vip->video_dev, VFL_TYPE_GRABBER, -1);  in sta2x11_vip_init_one()
1096 	vip->adapter = i2c_get_adapter(vip->config->i2c_id);  in sta2x11_vip_init_one()
1097 	if (!vip->adapter) {  in sta2x11_vip_init_one()
1103 	vip->decoder = v4l2_i2c_new_subdev(&vip->v4l2_dev, vip->adapter,  in sta2x11_vip_init_one()
1104 					   "adv7180", vip->config->i2c_addr,  in sta2x11_vip_init_one()
1106 	if (!vip->decoder) {  in sta2x11_vip_init_one()
1112 	i2c_put_adapter(vip->adapter);  in sta2x11_vip_init_one()
1113 	v4l2_subdev_call(vip->decoder, core, init, 0);  in sta2x11_vip_init_one()
1115 	sta2x11_vip_init_register(vip);  in sta2x11_vip_init_one()
1121 	video_set_drvdata(&vip->video_dev, NULL);  in sta2x11_vip_init_one()
1123 	video_unregister_device(&vip->video_dev);  in sta2x11_vip_init_one()
1124 	free_irq(pdev->irq, vip);  in sta2x11_vip_init_one()
1126 	sta2x11_vip_release_buffer(vip);  in sta2x11_vip_init_one()
1129 	vb2_queue_release(&vip->vb_vidq);  in sta2x11_vip_init_one()
1130 	pci_iounmap(pdev, vip->iomem);  in sta2x11_vip_init_one()
1134 	v4l2_device_unregister(&vip->v4l2_dev);  in sta2x11_vip_init_one()
1136 	kfree(vip);  in sta2x11_vip_init_one()
1163 	struct sta2x11_vip *vip =  in sta2x11_vip_remove_one()  local
1166 	sta2x11_vip_clear_register(vip);  in sta2x11_vip_remove_one()
1168 	video_set_drvdata(&vip->video_dev, NULL);  in sta2x11_vip_remove_one()
1169 	video_unregister_device(&vip->video_dev);  in sta2x11_vip_remove_one()
1170 	free_irq(pdev->irq, vip);  in sta2x11_vip_remove_one()
1172 	vb2_queue_release(&vip->vb_vidq);  in sta2x11_vip_remove_one()
1173 	pci_iounmap(pdev, vip->iomem);  in sta2x11_vip_remove_one()
1176 	v4l2_device_unregister(&vip->v4l2_dev);  in sta2x11_vip_remove_one()
1178 	vip_gpio_release(&pdev->dev, vip->config->pwr_pin,  in sta2x11_vip_remove_one()
1179 			 vip->config->pwr_name);  in sta2x11_vip_remove_one()
1180 	vip_gpio_release(&pdev->dev, vip->config->reset_pin,  in sta2x11_vip_remove_one()
1181 			 vip->config->reset_name);  in sta2x11_vip_remove_one()
1183 	kfree(vip);  in sta2x11_vip_remove_one()
1205 	struct sta2x11_vip *vip =  in sta2x11_vip_suspend()  local
1210 	spin_lock_irqsave(&vip->slock, flags);  in sta2x11_vip_suspend()
1211 	vip->register_save_area[0] = reg_read(vip, DVP_CTL);  in sta2x11_vip_suspend()
1212 	reg_write(vip, DVP_CTL, vip->register_save_area[0] & DVP_CTL_DIS);  in sta2x11_vip_suspend()
1213 	vip->register_save_area[SAVE_COUNT] = reg_read(vip, DVP_ITM);  in sta2x11_vip_suspend()
1214 	reg_write(vip, DVP_ITM, 0);  in sta2x11_vip_suspend()
1216 		vip->register_save_area[i] = reg_read(vip, 4 * i);  in sta2x11_vip_suspend()
1218 		vip->register_save_area[SAVE_COUNT + IRQ_COUNT + i] =  in sta2x11_vip_suspend()
1219 		    reg_read(vip, registers_to_save[i]);  in sta2x11_vip_suspend()
1220 	spin_unlock_irqrestore(&vip->slock, flags);  in sta2x11_vip_suspend()
1228 		vip->disabled = 1;  in sta2x11_vip_suspend()
1249 	struct sta2x11_vip *vip =  in sta2x11_vip_resume()  local
1256 	if (vip->disabled) {  in sta2x11_vip_resume()
1262 		vip->disabled = 0;  in sta2x11_vip_resume()
1271 		vip->disabled = 1;  in sta2x11_vip_resume()
1277 	spin_lock_irqsave(&vip->slock, flags);  in sta2x11_vip_resume()
1279 		reg_write(vip, 4 * i, vip->register_save_area[i]);  in sta2x11_vip_resume()
1281 		reg_write(vip, registers_to_save[i],  in sta2x11_vip_resume()
1282 			  vip->register_save_area[SAVE_COUNT + IRQ_COUNT + i]);  in sta2x11_vip_resume()
1283 	reg_write(vip, DVP_CTL, vip->register_save_area[0]);  in sta2x11_vip_resume()
1284 	reg_write(vip, DVP_ITM, vip->register_save_area[SAVE_COUNT]);  in sta2x11_vip_resume()
1285 	spin_unlock_irqrestore(&vip->slock, flags);  in sta2x11_vip_resume()