123 #define sensor_call(cam, optype, func, args...) \  argument
124 	v4l2_subdev_call(cam->sensor, optype, func, ##args)
129 #define cam_err(cam, fmt, arg...) \  argument
130 	dev_err(&(cam)->platdev->dev, fmt, ##arg);
131 #define cam_warn(cam, fmt, arg...) \  argument
132 	dev_warn(&(cam)->platdev->dev, fmt, ##arg);
133 #define cam_dbg(cam, fmt, arg...) \  argument
134 	dev_dbg(&(cam)->platdev->dev, fmt, ##arg);
178 static int via_sensor_power_setup(struct via_camera *cam)  in via_sensor_power_setup()  argument
182 	cam->power_gpio = viafb_gpio_lookup("VGPIO3");  in via_sensor_power_setup()
183 	cam->reset_gpio = viafb_gpio_lookup("VGPIO2");  in via_sensor_power_setup()
184 	if (cam->power_gpio < 0 || cam->reset_gpio < 0) {  in via_sensor_power_setup()
185 		dev_err(&cam->platdev->dev, "Unable to find GPIO lines\n");  in via_sensor_power_setup()
188 	ret = gpio_request(cam->power_gpio, "viafb-camera");  in via_sensor_power_setup()
190 		dev_err(&cam->platdev->dev, "Unable to request power GPIO\n");  in via_sensor_power_setup()
193 	ret = gpio_request(cam->reset_gpio, "viafb-camera");  in via_sensor_power_setup()
195 		dev_err(&cam->platdev->dev, "Unable to request reset GPIO\n");  in via_sensor_power_setup()
196 		gpio_free(cam->power_gpio);  in via_sensor_power_setup()
199 	gpio_direction_output(cam->power_gpio, 0);  in via_sensor_power_setup()
200 	gpio_direction_output(cam->reset_gpio, 0);  in via_sensor_power_setup()
207 static void via_sensor_power_up(struct via_camera *cam)  in via_sensor_power_up()  argument
209 	gpio_set_value(cam->power_gpio, 1);  in via_sensor_power_up()
210 	gpio_set_value(cam->reset_gpio, 0);  in via_sensor_power_up()
212 	gpio_set_value(cam->reset_gpio, 1);  in via_sensor_power_up()
216 static void via_sensor_power_down(struct via_camera *cam)  in via_sensor_power_down()  argument
218 	gpio_set_value(cam->power_gpio, 0);  in via_sensor_power_down()
219 	gpio_set_value(cam->reset_gpio, 0);  in via_sensor_power_down()
223 static void via_sensor_power_release(struct via_camera *cam)  in via_sensor_power_release()  argument
225 	via_sensor_power_down(cam);  in via_sensor_power_release()
226 	gpio_free(cam->power_gpio);  in via_sensor_power_release()
227 	gpio_free(cam->reset_gpio);  in via_sensor_power_release()
236 static int viacam_set_flip(struct via_camera *cam)  in viacam_set_flip()  argument
243 	return sensor_call(cam, core, s_ctrl, &ctrl);  in viacam_set_flip()
250 static int viacam_configure_sensor(struct via_camera *cam)  in viacam_configure_sensor()  argument
257 	v4l2_fill_mbus_format(&format.format, &cam->sensor_format, cam->mbus_code);  in viacam_configure_sensor()
258 	ret = sensor_call(cam, core, init, 0);  in viacam_configure_sensor()
260 		ret = sensor_call(cam, pad, set_fmt, NULL, &format);  in viacam_configure_sensor()
265 		ret = viacam_set_flip(cam);  in viacam_configure_sensor()
279 static inline void viacam_write_reg(struct via_camera *cam,  in viacam_write_reg()  argument
282 	iowrite32(value, cam->mmio + reg);  in viacam_write_reg()
285 static inline int viacam_read_reg(struct via_camera *cam, int reg)  in viacam_read_reg()  argument
287 	return ioread32(cam->mmio + reg);  in viacam_read_reg()
290 static inline void viacam_write_reg_mask(struct via_camera *cam,  in viacam_write_reg_mask()  argument
293 	int tmp = viacam_read_reg(cam, reg);  in viacam_write_reg_mask()
296 	viacam_write_reg(cam, reg, tmp);  in viacam_write_reg_mask()
305 	struct via_camera *cam = data;  in viacam_quick_irq()  local
313 	spin_lock(&cam->viadev->reg_lock);  in viacam_quick_irq()
314 	icv = viacam_read_reg(cam, VCR_INTCTRL);  in viacam_quick_irq()
317 		viacam_write_reg(cam, VCR_INTCTRL, icv);  in viacam_quick_irq()
320 	spin_unlock(&cam->viadev->reg_lock);  in viacam_quick_irq()
327 static struct videobuf_buffer *viacam_next_buffer(struct via_camera *cam)  in viacam_next_buffer()  argument
332 	spin_lock_irqsave(&cam->viadev->reg_lock, flags);  in viacam_next_buffer()
333 	if (cam->opstate != S_RUNNING)  in viacam_next_buffer()
335 	if (list_empty(&cam->buffer_queue))  in viacam_next_buffer()
337 	buf = list_entry(cam->buffer_queue.next, struct videobuf_buffer, queue);  in viacam_next_buffer()
345 	spin_unlock_irqrestore(&cam->viadev->reg_lock, flags);  in viacam_next_buffer()
356 	struct via_camera *cam = data;  in viacam_irq()  local
363 	vb = viacam_next_buffer(cam);  in viacam_irq()
369 	bufn = (viacam_read_reg(cam, VCR_INTCTRL) & VCR_IC_ACTBUF) >> 3;  in viacam_irq()
372 		bufn = cam->n_cap_bufs - 1;  in viacam_irq()
377 	viafb_dma_copy_out_sg(cam->cb_offsets[bufn], vdma->sglist, vdma->sglen);  in viacam_irq()
379 	vb->size = cam->user_format.sizeimage;  in viacam_irq()
393 static void viacam_int_enable(struct via_camera *cam)  in viacam_int_enable()  argument
395 	viacam_write_reg(cam, VCR_INTCTRL,  in viacam_int_enable()
400 static void viacam_int_disable(struct via_camera *cam)  in viacam_int_disable()  argument
403 	viacam_write_reg(cam, VCR_INTCTRL, 0);  in viacam_int_disable()
414 static int viacam_ctlr_cbufs(struct via_camera *cam)  in viacam_ctlr_cbufs()  argument
416 	int nbuf = cam->viadev->camera_fbmem_size/cam->sensor_format.sizeimage;  in viacam_ctlr_cbufs()
424 		cam->n_cap_bufs = 3;  in viacam_ctlr_cbufs()
425 		viacam_write_reg_mask(cam, VCR_CAPINTC, VCR_CI_3BUFS,  in viacam_ctlr_cbufs()
428 		cam->n_cap_bufs = 2;  in viacam_ctlr_cbufs()
429 		viacam_write_reg_mask(cam, VCR_CAPINTC, 0, VCR_CI_3BUFS);  in viacam_ctlr_cbufs()
431 		cam_warn(cam, "Insufficient frame buffer memory\n");  in viacam_ctlr_cbufs()
437 	offset = cam->fb_offset;  in viacam_ctlr_cbufs()
438 	for (i = 0; i < cam->n_cap_bufs; i++) {  in viacam_ctlr_cbufs()
439 		cam->cb_offsets[i] = offset;  in viacam_ctlr_cbufs()
440 		cam->cb_addrs[i] = cam->fbmem + offset;  in viacam_ctlr_cbufs()
441 		viacam_write_reg(cam, VCR_VBUF1 + i*4, offset & VCR_VBUF_MASK);  in viacam_ctlr_cbufs()
442 		offset += cam->sensor_format.sizeimage;  in viacam_ctlr_cbufs()
464 static void viacam_set_scale(struct via_camera *cam)  in viacam_set_scale()  argument
469 	if (cam->user_format.width == VGA_WIDTH)  in viacam_set_scale()
472 		sf = (cam->user_format.width*2048)/VGA_WIDTH;  in viacam_set_scale()
475 	if (cam->user_format.height < VGA_HEIGHT) {  in viacam_set_scale()
476 		sf = (1024*cam->user_format.height)/VGA_HEIGHT;  in viacam_set_scale()
479 	viacam_write_reg(cam, VCR_AVSCALE, avscale);  in viacam_set_scale()
486 static void viacam_ctlr_image(struct via_camera *cam)  in viacam_ctlr_image()  argument
494 	viacam_write_reg(cam, VCR_CAPINTC, ~(VCR_CI_ENABLE|VCR_CI_CLKEN));  in viacam_ctlr_image()
499 	viacam_write_reg(cam, VCR_HORRANGE, 0x06200120);  in viacam_ctlr_image()
500 	viacam_write_reg(cam, VCR_VERTRANGE, 0x01de0000);  in viacam_ctlr_image()
501 	viacam_set_scale(cam);  in viacam_ctlr_image()
505 	viacam_write_reg(cam, VCR_MAXDATA,  in viacam_ctlr_image()
506 			(cam->sensor_format.height << 16) |  in viacam_ctlr_image()
507 			(cam->sensor_format.bytesperline >> 3));  in viacam_ctlr_image()
508 	viacam_write_reg(cam, VCR_MAXVBI, 0);  in viacam_ctlr_image()
509 	viacam_write_reg(cam, VCR_VSTRIDE,  in viacam_ctlr_image()
510 			cam->user_format.bytesperline & VCR_VS_STRIDE);  in viacam_ctlr_image()
524 	if (cam->n_cap_bufs == 3)  in viacam_ctlr_image()
529 	if (cam->user_format.pixelformat == V4L2_PIX_FMT_YUYV)  in viacam_ctlr_image()
533 	viacam_write_reg(cam, VCR_CAPINTC, cicreg);  in viacam_ctlr_image()
537 static int viacam_config_controller(struct via_camera *cam)  in viacam_config_controller()  argument
542 	spin_lock_irqsave(&cam->viadev->reg_lock, flags);  in viacam_config_controller()
543 	ret = viacam_ctlr_cbufs(cam);  in viacam_config_controller()
545 		viacam_ctlr_image(cam);  in viacam_config_controller()
546 	spin_unlock_irqrestore(&cam->viadev->reg_lock, flags);  in viacam_config_controller()
547 	clear_bit(CF_CONFIG_NEEDED, &cam->flags);  in viacam_config_controller()
554 static void viacam_start_engine(struct via_camera *cam)  in viacam_start_engine()  argument
556 	spin_lock_irq(&cam->viadev->reg_lock);  in viacam_start_engine()
557 	cam->next_buf = 0;  in viacam_start_engine()
558 	viacam_write_reg_mask(cam, VCR_CAPINTC, VCR_CI_ENABLE, VCR_CI_ENABLE);  in viacam_start_engine()
559 	viacam_int_enable(cam);  in viacam_start_engine()
560 	(void) viacam_read_reg(cam, VCR_CAPINTC); /* Force post */  in viacam_start_engine()
561 	cam->opstate = S_RUNNING;  in viacam_start_engine()
562 	spin_unlock_irq(&cam->viadev->reg_lock);  in viacam_start_engine()
566 static void viacam_stop_engine(struct via_camera *cam)  in viacam_stop_engine()  argument
568 	spin_lock_irq(&cam->viadev->reg_lock);  in viacam_stop_engine()
569 	viacam_int_disable(cam);  in viacam_stop_engine()
570 	viacam_write_reg_mask(cam, VCR_CAPINTC, 0, VCR_CI_ENABLE);  in viacam_stop_engine()
571 	(void) viacam_read_reg(cam, VCR_CAPINTC); /* Force post */  in viacam_stop_engine()
572 	cam->opstate = S_IDLE;  in viacam_stop_engine()
573 	spin_unlock_irq(&cam->viadev->reg_lock);  in viacam_stop_engine()
588 	struct via_camera *cam = q->priv_data;  in viacam_vb_buf_setup()  local
590 	*size = cam->user_format.sizeimage;  in viacam_vb_buf_setup()
602 	struct via_camera *cam = q->priv_data;  in viacam_vb_buf_prepare()  local
604 	vb->size = cam->user_format.sizeimage;  in viacam_vb_buf_prepare()
605 	vb->width = cam->user_format.width; /* bytesperline???? */  in viacam_vb_buf_prepare()
606 	vb->height = cam->user_format.height;  in viacam_vb_buf_prepare()
625 	struct via_camera *cam = q->priv_data;  in viacam_vb_buf_queue()  local
632 	list_add_tail(&vb->queue, &cam->buffer_queue);  in viacam_vb_buf_queue()
641 	struct via_camera *cam = q->priv_data;  in viacam_vb_buf_release()  local
643 	videobuf_dma_unmap(&cam->platdev->dev, videobuf_to_dma(vb));  in viacam_vb_buf_release()
660 	struct via_camera *cam = video_drvdata(filp);  in viacam_open()  local
662 	filp->private_data = cam;  in viacam_open()
667 	mutex_lock(&cam->lock);  in viacam_open()
668 	if (cam->users == 0) {  in viacam_open()
672 			mutex_unlock(&cam->lock);  in viacam_open()
675 		via_sensor_power_up(cam);  in viacam_open()
676 		set_bit(CF_CONFIG_NEEDED, &cam->flags);  in viacam_open()
680 		videobuf_queue_sg_init(&cam->vb_queue, &viacam_vb_ops,  in viacam_open()
681 				&cam->platdev->dev, &cam->viadev->reg_lock,  in viacam_open()
683 				sizeof(struct videobuf_buffer), cam, NULL);  in viacam_open()
685 	(cam->users)++;  in viacam_open()
686 	mutex_unlock(&cam->lock);  in viacam_open()
692 	struct via_camera *cam = video_drvdata(filp);  in viacam_release()  local
694 	mutex_lock(&cam->lock);  in viacam_release()
695 	(cam->users)--;  in viacam_release()
700 	if (filp == cam->owner) {  in viacam_release()
701 		videobuf_stop(&cam->vb_queue);  in viacam_release()
708 		if (cam->opstate != S_IDLE)  in viacam_release()
709 			viacam_stop_engine(cam);  in viacam_release()
710 		cam->owner = NULL;  in viacam_release()
715 	if (cam->users == 0) {  in viacam_release()
716 		videobuf_mmap_free(&cam->vb_queue);  in viacam_release()
717 		via_sensor_power_down(cam);  in viacam_release()
720 	mutex_unlock(&cam->lock);  in viacam_release()
730 	struct via_camera *cam = video_drvdata(filp);  in viacam_read()  local
733 	mutex_lock(&cam->lock);  in viacam_read()
737 	if (cam->owner && cam->owner != filp) {  in viacam_read()
741 	cam->owner = filp;  in viacam_read()
745 	if (test_bit(CF_CONFIG_NEEDED, &cam->flags)) {  in viacam_read()
746 		ret = viacam_configure_sensor(cam);  in viacam_read()
748 			ret = viacam_config_controller(cam);  in viacam_read()
757 	INIT_LIST_HEAD(&cam->buffer_queue);  in viacam_read()
758 	viacam_start_engine(cam);  in viacam_read()
759 	ret = videobuf_read_stream(&cam->vb_queue, buffer, len, pos, 0,  in viacam_read()
761 	viacam_stop_engine(cam);  in viacam_read()
765 	mutex_unlock(&cam->lock);  in viacam_read()
772 	struct via_camera *cam = video_drvdata(filp);  in viacam_poll()  local
774 	return videobuf_poll_stream(filp, &cam->vb_queue, pt);  in viacam_poll()
780 	struct via_camera *cam = video_drvdata(filp);  in viacam_mmap()  local
782 	return videobuf_mmap_mapper(&cam->vb_queue, vma);  in viacam_mmap()
904 static int viacam_do_try_fmt(struct via_camera *cam,  in viacam_do_try_fmt()  argument
917 	ret = sensor_call(cam, pad, set_fmt, &pad_cfg, &format);  in viacam_do_try_fmt()
928 	struct via_camera *cam = priv;  in viacam_try_fmt_vid_cap()  local
932 	mutex_lock(&cam->lock);  in viacam_try_fmt_vid_cap()
933 	ret = viacam_do_try_fmt(cam, &fmt->fmt.pix, &sfmt.fmt.pix);  in viacam_try_fmt_vid_cap()
934 	mutex_unlock(&cam->lock);  in viacam_try_fmt_vid_cap()
942 	struct via_camera *cam = priv;  in viacam_g_fmt_vid_cap()  local
944 	mutex_lock(&cam->lock);  in viacam_g_fmt_vid_cap()
945 	fmt->fmt.pix = cam->user_format;  in viacam_g_fmt_vid_cap()
946 	mutex_unlock(&cam->lock);  in viacam_g_fmt_vid_cap()
953 	struct via_camera *cam = priv;  in viacam_s_fmt_vid_cap()  local
962 	mutex_lock(&cam->lock);  in viacam_s_fmt_vid_cap()
963 	if (cam->opstate != S_IDLE) {  in viacam_s_fmt_vid_cap()
971 	ret = viacam_do_try_fmt(cam, &fmt->fmt.pix, &sfmt.fmt.pix);  in viacam_s_fmt_vid_cap()
977 	cam->user_format = fmt->fmt.pix;  in viacam_s_fmt_vid_cap()
978 	cam->sensor_format = sfmt.fmt.pix;  in viacam_s_fmt_vid_cap()
979 	cam->mbus_code = f->mbus_code;  in viacam_s_fmt_vid_cap()
980 	ret = viacam_configure_sensor(cam);  in viacam_s_fmt_vid_cap()
982 		ret = viacam_config_controller(cam);  in viacam_s_fmt_vid_cap()
984 	mutex_unlock(&cam->lock);  in viacam_s_fmt_vid_cap()
1005 	struct via_camera *cam = priv;  in viacam_reqbufs()  local
1007 	return videobuf_reqbufs(&cam->vb_queue, rb);  in viacam_reqbufs()
1013 	struct via_camera *cam = priv;  in viacam_querybuf()  local
1015 	return videobuf_querybuf(&cam->vb_queue, buf);  in viacam_querybuf()
1020 	struct via_camera *cam = priv;  in viacam_qbuf()  local
1022 	return videobuf_qbuf(&cam->vb_queue, buf);  in viacam_qbuf()
1027 	struct via_camera *cam = priv;  in viacam_dqbuf()  local
1029 	return videobuf_dqbuf(&cam->vb_queue, buf, filp->f_flags & O_NONBLOCK);  in viacam_dqbuf()
1034 	struct via_camera *cam = priv;  in viacam_streamon()  local
1040 	mutex_lock(&cam->lock);  in viacam_streamon()
1041 	if (cam->opstate != S_IDLE) {  in viacam_streamon()
1048 	if (cam->owner && cam->owner != filp) {  in viacam_streamon()
1052 	cam->owner = filp;  in viacam_streamon()
1056 	if (test_bit(CF_CONFIG_NEEDED, &cam->flags)) {  in viacam_streamon()
1057 		ret = viacam_configure_sensor(cam);  in viacam_streamon()
1060 		ret = viacam_config_controller(cam);  in viacam_streamon()
1070 	pm_qos_add_request(&cam->qos_request, PM_QOS_CPU_DMA_LATENCY, 50);  in viacam_streamon()
1074 	INIT_LIST_HEAD(&cam->buffer_queue);  in viacam_streamon()
1075 	ret = videobuf_streamon(&cam->vb_queue);  in viacam_streamon()
1077 		viacam_start_engine(cam);  in viacam_streamon()
1079 	mutex_unlock(&cam->lock);  in viacam_streamon()
1085 	struct via_camera *cam = priv;  in viacam_streamoff()  local
1090 	mutex_lock(&cam->lock);  in viacam_streamoff()
1091 	if (cam->opstate != S_RUNNING) {  in viacam_streamoff()
1095 	pm_qos_remove_request(&cam->qos_request);  in viacam_streamoff()
1096 	viacam_stop_engine(cam);  in viacam_streamoff()
1102 	ret = videobuf_streamoff(&cam->vb_queue);  in viacam_streamoff()
1103 	INIT_LIST_HEAD(&cam->buffer_queue);  in viacam_streamoff()
1105 	mutex_unlock(&cam->lock);  in viacam_streamoff()
1114 	struct via_camera *cam = priv;  in viacam_g_parm()  local
1117 	mutex_lock(&cam->lock);  in viacam_g_parm()
1118 	ret = sensor_call(cam, video, g_parm, parm);  in viacam_g_parm()
1119 	mutex_unlock(&cam->lock);  in viacam_g_parm()
1120 	parm->parm.capture.readbuffers = cam->n_cap_bufs;  in viacam_g_parm()
1127 	struct via_camera *cam = priv;  in viacam_s_parm()  local
1130 	mutex_lock(&cam->lock);  in viacam_s_parm()
1131 	ret = sensor_call(cam, video, s_parm, parm);  in viacam_s_parm()
1132 	mutex_unlock(&cam->lock);  in viacam_s_parm()
1133 	parm->parm.capture.readbuffers = cam->n_cap_bufs;  in viacam_s_parm()
1154 	struct via_camera *cam = priv;  in viacam_enum_frameintervals()  local
1157 		.code = cam->mbus_code,  in viacam_enum_frameintervals()
1158 		.width = cam->sensor_format.width,  in viacam_enum_frameintervals()
1159 		.height = cam->sensor_format.height,  in viacam_enum_frameintervals()
1164 	mutex_lock(&cam->lock);  in viacam_enum_frameintervals()
1165 	ret = sensor_call(cam, pad, enum_frame_interval, NULL, &fie);  in viacam_enum_frameintervals()
1166 	mutex_unlock(&cam->lock);  in viacam_enum_frameintervals()
1208 	struct via_camera *cam = priv;  in viacam_suspend()  local
1209 	enum viacam_opstate state = cam->opstate;  in viacam_suspend()
1211 	if (cam->opstate != S_IDLE) {  in viacam_suspend()
1212 		viacam_stop_engine(cam);  in viacam_suspend()
1213 		cam->opstate = state; /* So resume restarts */  in viacam_suspend()
1221 	struct via_camera *cam = priv;  in viacam_resume()  local
1229 	viacam_int_disable(cam);  in viacam_resume()
1230 	set_bit(CF_CONFIG_NEEDED, &cam->flags);  in viacam_resume()
1234 	if (cam->users > 0)  in viacam_resume()
1235 		via_sensor_power_up(cam);  in viacam_resume()
1237 		via_sensor_power_down(cam);  in viacam_resume()
1241 	if (cam->opstate != S_IDLE) {  in viacam_resume()
1242 		mutex_lock(&cam->lock);  in viacam_resume()
1243 		ret = viacam_configure_sensor(cam);  in viacam_resume()
1245 			ret = viacam_config_controller(cam);  in viacam_resume()
1246 		mutex_unlock(&cam->lock);  in viacam_resume()
1248 			viacam_start_engine(cam);  in viacam_resume()
1330 	struct via_camera *cam;  in viacam_probe()  local
1355 	cam = kzalloc (sizeof(struct via_camera), GFP_KERNEL);  in viacam_probe()
1356 	if (cam == NULL)  in viacam_probe()
1358 	via_cam_info = cam;  in viacam_probe()
1359 	cam->platdev = pdev;  in viacam_probe()
1360 	cam->viadev = viadev;  in viacam_probe()
1361 	cam->users = 0;  in viacam_probe()
1362 	cam->owner = NULL;  in viacam_probe()
1363 	cam->opstate = S_IDLE;  in viacam_probe()
1364 	cam->user_format = cam->sensor_format = viacam_def_pix_format;  in viacam_probe()
1365 	mutex_init(&cam->lock);  in viacam_probe()
1366 	INIT_LIST_HEAD(&cam->buffer_queue);  in viacam_probe()
1367 	cam->mmio = viadev->engine_mmio;  in viacam_probe()
1368 	cam->fbmem = viadev->fbmem;  in viacam_probe()
1369 	cam->fb_offset = viadev->camera_fbmem_offset;  in viacam_probe()
1370 	cam->flags = 1 << CF_CONFIG_NEEDED;  in viacam_probe()
1371 	cam->mbus_code = via_def_mbus_code;  in viacam_probe()
1375 	ret = v4l2_device_register(&pdev->dev, &cam->v4l2_dev);  in viacam_probe()
1380 	ret = v4l2_ctrl_handler_init(&cam->ctrl_handler, 10);  in viacam_probe()
1383 	cam->v4l2_dev.ctrl_handler = &cam->ctrl_handler;  in viacam_probe()
1398 	ret = via_sensor_power_setup(cam);  in viacam_probe()
1401 	via_sensor_power_up(cam);  in viacam_probe()
1408 	cam->sensor = v4l2_i2c_new_subdev_board(&cam->v4l2_dev, sensor_adapter,  in viacam_probe()
1410 	if (cam->sensor == NULL) {  in viacam_probe()
1418 	viacam_int_disable(cam);  in viacam_probe()
1420 			viacam_irq, IRQF_SHARED, "via-camera", cam);  in viacam_probe()
1426 	cam->vdev = viacam_v4l_template;  in viacam_probe()
1427 	cam->vdev.v4l2_dev = &cam->v4l2_dev;  in viacam_probe()
1428 	ret = video_register_device(&cam->vdev, VFL_TYPE_GRABBER, -1);  in viacam_probe()
1431 	video_set_drvdata(&cam->vdev, cam);  in viacam_probe()
1437 	viacam_pm_hooks.private = cam;  in viacam_probe()
1442 	via_sensor_power_down(cam);  in viacam_probe()
1446 	free_irq(viadev->pdev->irq, cam);  in viacam_probe()
1448 	via_sensor_power_release(cam);  in viacam_probe()
1450 	v4l2_ctrl_handler_free(&cam->ctrl_handler);  in viacam_probe()
1452 	v4l2_device_unregister(&cam->v4l2_dev);  in viacam_probe()
1454 	kfree(cam);  in viacam_probe()
1460 	struct via_camera *cam = via_cam_info;  in viacam_remove()  local
1463 	video_unregister_device(&cam->vdev);  in viacam_remove()
1464 	v4l2_device_unregister(&cam->v4l2_dev);  in viacam_remove()
1465 	free_irq(viadev->pdev->irq, cam);  in viacam_remove()
1466 	via_sensor_power_release(cam);  in viacam_remove()
1467 	v4l2_ctrl_handler_free(&cam->ctrl_handler);  in viacam_remove()
1468 	kfree(cam);  in viacam_remove()