Lines Matching refs:cam
127 #define sensor_call(cam, optype, func, args...) \
128 v4l2_subdev_call(cam->sensor, optype, func, ##args)
133 #define cam_err(cam, fmt, arg...) \
134 dev_err(&(cam)->platdev->dev, fmt, ##arg)
135 #define cam_warn(cam, fmt, arg...) \
136 dev_warn(&(cam)->platdev->dev, fmt, ##arg)
137 #define cam_dbg(cam, fmt, arg...) \
138 dev_dbg(&(cam)->platdev->dev, fmt, ##arg)
180 static int via_sensor_power_setup(struct via_camera *cam)
182 struct device *dev = &cam->platdev->dev;
184 cam->power_gpio = devm_gpiod_get(dev, "VGPIO3", GPIOD_OUT_LOW);
185 if (IS_ERR(cam->power_gpio))
186 return dev_err_probe(dev, PTR_ERR(cam->power_gpio),
190 cam->reset_gpio = devm_gpiod_get(dev, "VGPIO2", GPIOD_OUT_HIGH);
191 if (IS_ERR(cam->reset_gpio))
192 return dev_err_probe(dev, PTR_ERR(cam->reset_gpio),
201 static void via_sensor_power_up(struct via_camera *cam)
203 gpiod_set_value(cam->power_gpio, 1);
204 gpiod_set_value(cam->reset_gpio, 1);
206 gpiod_set_value(cam->reset_gpio, 0);
210 static void via_sensor_power_down(struct via_camera *cam)
212 gpiod_set_value(cam->power_gpio, 0);
213 gpiod_set_value(cam->reset_gpio, 1);
217 static void via_sensor_power_release(struct via_camera *cam)
219 via_sensor_power_down(cam);
228 static int viacam_set_flip(struct via_camera *cam)
235 return v4l2_s_ctrl(NULL, cam->sensor->ctrl_handler, &ctrl);
242 static int viacam_configure_sensor(struct via_camera *cam)
249 v4l2_fill_mbus_format(&format.format, &cam->sensor_format, cam->mbus_code);
250 ret = sensor_call(cam, core, init, 0);
252 ret = sensor_call(cam, pad, set_fmt, NULL, &format);
257 ret = viacam_set_flip(cam);
271 static inline void viacam_write_reg(struct via_camera *cam,
274 iowrite32(value, cam->mmio + reg);
277 static inline int viacam_read_reg(struct via_camera *cam, int reg)
279 return ioread32(cam->mmio + reg);
282 static inline void viacam_write_reg_mask(struct via_camera *cam,
285 int tmp = viacam_read_reg(cam, reg);
288 viacam_write_reg(cam, reg, tmp);
297 struct via_camera *cam = data;
305 spin_lock(&cam->viadev->reg_lock);
306 icv = viacam_read_reg(cam, VCR_INTCTRL);
309 viacam_write_reg(cam, VCR_INTCTRL, icv);
312 spin_unlock(&cam->viadev->reg_lock);
319 static struct via_buffer *viacam_next_buffer(struct via_camera *cam)
321 if (cam->opstate != S_RUNNING)
323 if (list_empty(&cam->buffer_queue))
325 return list_entry(cam->buffer_queue.next, struct via_buffer, queue);
333 struct via_camera *cam = data;
338 mutex_lock(&cam->lock);
343 vb = viacam_next_buffer(cam);
349 bufn = (viacam_read_reg(cam, VCR_INTCTRL) & VCR_IC_ACTBUF) >> 3;
352 bufn = cam->n_cap_bufs - 1;
358 viafb_dma_copy_out_sg(cam->cb_offsets[bufn], sgt->sgl, sgt->nents);
359 vb->vbuf.sequence = cam->sequence++;
364 mutex_unlock(&cam->lock);
376 static void viacam_int_enable(struct via_camera *cam)
378 viacam_write_reg(cam, VCR_INTCTRL,
383 static void viacam_int_disable(struct via_camera *cam)
386 viacam_write_reg(cam, VCR_INTCTRL, 0);
397 static int viacam_ctlr_cbufs(struct via_camera *cam)
399 int nbuf = cam->viadev->camera_fbmem_size/cam->sensor_format.sizeimage;
407 cam->n_cap_bufs = 3;
408 viacam_write_reg_mask(cam, VCR_CAPINTC, VCR_CI_3BUFS,
411 cam->n_cap_bufs = 2;
412 viacam_write_reg_mask(cam, VCR_CAPINTC, 0, VCR_CI_3BUFS);
414 cam_warn(cam, "Insufficient frame buffer memory\n");
420 offset = cam->fb_offset;
421 for (i = 0; i < cam->n_cap_bufs; i++) {
422 cam->cb_offsets[i] = offset;
423 cam->cb_addrs[i] = cam->fbmem + offset;
424 viacam_write_reg(cam, VCR_VBUF1 + i*4, offset & VCR_VBUF_MASK);
425 offset += cam->sensor_format.sizeimage;
447 static void viacam_set_scale(struct via_camera *cam)
452 if (cam->user_format.width == VGA_WIDTH)
455 sf = (cam->user_format.width*2048)/VGA_WIDTH;
458 if (cam->user_format.height < VGA_HEIGHT) {
459 sf = (1024*cam->user_format.height)/VGA_HEIGHT;
462 viacam_write_reg(cam, VCR_AVSCALE, avscale);
469 static void viacam_ctlr_image(struct via_camera *cam)
477 viacam_write_reg(cam, VCR_CAPINTC, ~(VCR_CI_ENABLE|VCR_CI_CLKEN));
482 viacam_write_reg(cam, VCR_HORRANGE, 0x06200120);
483 viacam_write_reg(cam, VCR_VERTRANGE, 0x01de0000);
484 viacam_set_scale(cam);
488 viacam_write_reg(cam, VCR_MAXDATA,
489 (cam->sensor_format.height << 16) |
490 (cam->sensor_format.bytesperline >> 3));
491 viacam_write_reg(cam, VCR_MAXVBI, 0);
492 viacam_write_reg(cam, VCR_VSTRIDE,
493 cam->user_format.bytesperline & VCR_VS_STRIDE);
507 if (cam->n_cap_bufs == 3)
512 if (cam->user_format.pixelformat == V4L2_PIX_FMT_YUYV)
516 viacam_write_reg(cam, VCR_CAPINTC, cicreg);
520 static int viacam_config_controller(struct via_camera *cam)
525 spin_lock_irqsave(&cam->viadev->reg_lock, flags);
526 ret = viacam_ctlr_cbufs(cam);
528 viacam_ctlr_image(cam);
529 spin_unlock_irqrestore(&cam->viadev->reg_lock, flags);
530 clear_bit(CF_CONFIG_NEEDED, &cam->flags);
537 static void viacam_start_engine(struct via_camera *cam)
539 spin_lock_irq(&cam->viadev->reg_lock);
540 viacam_write_reg_mask(cam, VCR_CAPINTC, VCR_CI_ENABLE, VCR_CI_ENABLE);
541 viacam_int_enable(cam);
542 (void) viacam_read_reg(cam, VCR_CAPINTC); /* Force post */
543 cam->opstate = S_RUNNING;
544 spin_unlock_irq(&cam->viadev->reg_lock);
548 static void viacam_stop_engine(struct via_camera *cam)
550 spin_lock_irq(&cam->viadev->reg_lock);
551 viacam_int_disable(cam);
552 viacam_write_reg_mask(cam, VCR_CAPINTC, 0, VCR_CI_ENABLE);
553 (void) viacam_read_reg(cam, VCR_CAPINTC); /* Force post */
554 cam->opstate = S_IDLE;
555 spin_unlock_irq(&cam->viadev->reg_lock);
571 struct via_camera *cam = vb2_get_drv_priv(vb->vb2_queue);
574 list_add_tail(&via->queue, &cam->buffer_queue);
579 struct via_camera *cam = vb2_get_drv_priv(vb->vb2_queue);
581 if (vb2_plane_size(vb, 0) < cam->user_format.sizeimage) {
582 cam_dbg(cam,
585 cam->user_format.sizeimage);
589 vb2_set_plane_payload(vb, 0, cam->user_format.sizeimage);
599 struct via_camera *cam = vb2_get_drv_priv(vq);
600 int size = cam->user_format.sizeimage;
612 struct via_camera *cam = vb2_get_drv_priv(vq);
616 if (cam->opstate != S_IDLE) {
623 if (test_bit(CF_CONFIG_NEEDED, &cam->flags)) {
624 ret = viacam_configure_sensor(cam);
627 ret = viacam_config_controller(cam);
631 cam->sequence = 0;
638 cpu_latency_qos_add_request(&cam->qos_request, 50);
639 viacam_start_engine(cam);
642 list_for_each_entry_safe(buf, tmp, &cam->buffer_queue, queue) {
651 struct via_camera *cam = vb2_get_drv_priv(vq);
654 cpu_latency_qos_remove_request(&cam->qos_request);
655 viacam_stop_engine(cam);
657 list_for_each_entry_safe(buf, tmp, &cam->buffer_queue, queue) {
678 struct via_camera *cam = video_drvdata(filp);
685 mutex_lock(&cam->lock);
696 via_sensor_power_up(cam);
697 set_bit(CF_CONFIG_NEEDED, &cam->flags);
700 mutex_unlock(&cam->lock);
706 struct via_camera *cam = video_drvdata(filp);
709 mutex_lock(&cam->lock);
716 via_sensor_power_down(cam);
719 mutex_unlock(&cam->lock);
831 static int viacam_do_try_fmt(struct via_camera *cam,
847 ret = sensor_call(cam, pad, set_fmt, &pad_state, &format);
858 struct via_camera *cam = video_drvdata(filp);
861 return viacam_do_try_fmt(cam, &fmt->fmt.pix, &sfmt.fmt.pix);
868 struct via_camera *cam = video_drvdata(filp);
870 fmt->fmt.pix = cam->user_format;
877 struct via_camera *cam = video_drvdata(filp);
886 if (cam->opstate != S_IDLE)
892 ret = viacam_do_try_fmt(cam, &fmt->fmt.pix, &sfmt.fmt.pix);
898 cam->user_format = fmt->fmt.pix;
899 cam->sensor_format = sfmt.fmt.pix;
900 cam->mbus_code = f->mbus_code;
901 ret = viacam_configure_sensor(cam);
903 ret = viacam_config_controller(cam);
921 struct via_camera *cam = video_drvdata(filp);
923 return v4l2_g_parm_cap(video_devdata(filp), cam->sensor, parm);
929 struct via_camera *cam = video_drvdata(filp);
931 return v4l2_s_parm_cap(video_devdata(filp), cam->sensor, parm);
958 struct via_camera *cam = video_drvdata(filp);
961 .code = cam->mbus_code,
962 .width = cam->sensor_format.width,
963 .height = cam->sensor_format.height,
977 ret = sensor_call(cam, pad, enum_frame_interval, NULL, &fie);
1020 struct via_camera *cam = priv;
1021 enum viacam_opstate state = cam->opstate;
1023 if (cam->opstate != S_IDLE) {
1024 viacam_stop_engine(cam);
1025 cam->opstate = state; /* So resume restarts */
1033 struct via_camera *cam = priv;
1041 viacam_int_disable(cam);
1042 set_bit(CF_CONFIG_NEEDED, &cam->flags);
1046 if (!list_empty(&cam->vdev.fh_list))
1047 via_sensor_power_up(cam);
1049 via_sensor_power_down(cam);
1053 if (cam->opstate != S_IDLE) {
1054 mutex_lock(&cam->lock);
1055 ret = viacam_configure_sensor(cam);
1057 ret = viacam_config_controller(cam);
1058 mutex_unlock(&cam->lock);
1060 viacam_start_engine(cam);
1144 struct via_camera *cam;
1169 cam = kzalloc (sizeof(struct via_camera), GFP_KERNEL);
1170 if (cam == NULL)
1172 via_cam_info = cam;
1173 cam->platdev = pdev;
1174 cam->viadev = viadev;
1175 cam->opstate = S_IDLE;
1176 cam->user_format = cam->sensor_format = viacam_def_pix_format;
1177 mutex_init(&cam->lock);
1178 INIT_LIST_HEAD(&cam->buffer_queue);
1179 cam->mmio = viadev->engine_mmio;
1180 cam->fbmem = viadev->fbmem;
1181 cam->fb_offset = viadev->camera_fbmem_offset;
1182 cam->flags = 1 << CF_CONFIG_NEEDED;
1183 cam->mbus_code = via_def_mbus_code;
1187 ret = v4l2_device_register(&pdev->dev, &cam->v4l2_dev);
1192 ret = v4l2_ctrl_handler_init(&cam->ctrl_handler, 10);
1195 cam->v4l2_dev.ctrl_handler = &cam->ctrl_handler;
1212 ret = via_sensor_power_setup(cam);
1215 via_sensor_power_up(cam);
1222 cam->sensor = v4l2_i2c_new_subdev_board(&cam->v4l2_dev, sensor_adapter,
1224 if (cam->sensor == NULL) {
1232 viacam_int_disable(cam);
1234 viacam_irq, IRQF_SHARED, "via-camera", cam);
1238 vq = &cam->vq;
1241 vq->drv_priv = cam;
1244 vq->dev = cam->v4l2_dev.dev;
1248 vq->lock = &cam->lock;
1254 cam->vdev = viacam_v4l_template;
1255 cam->vdev.v4l2_dev = &cam->v4l2_dev;
1256 cam->vdev.lock = &cam->lock;
1257 cam->vdev.queue = vq;
1258 video_set_drvdata(&cam->vdev, cam);
1259 ret = video_register_device(&cam->vdev, VFL_TYPE_VIDEO, -1);
1267 viacam_pm_hooks.private = cam;
1272 via_sensor_power_down(cam);
1276 free_irq(viadev->pdev->irq, cam);
1278 via_sensor_power_release(cam);
1280 v4l2_ctrl_handler_free(&cam->ctrl_handler);
1282 v4l2_device_unregister(&cam->v4l2_dev);
1284 kfree(cam);
1290 struct via_camera *cam = via_cam_info;
1293 video_unregister_device(&cam->vdev);
1294 v4l2_device_unregister(&cam->v4l2_dev);
1298 free_irq(viadev->pdev->irq, cam);
1299 via_sensor_power_release(cam);
1300 v4l2_ctrl_handler_free(&cam->ctrl_handler);
1301 kfree(cam);