Lines Matching refs:cam
128 #define sensor_call(cam, optype, func, args...) \ argument
129 v4l2_subdev_call(cam->sensor, optype, func, ##args)
134 #define cam_err(cam, fmt, arg...) \ argument
135 dev_err(&(cam)->platdev->dev, fmt, ##arg);
136 #define cam_warn(cam, fmt, arg...) \ argument
137 dev_warn(&(cam)->platdev->dev, fmt, ##arg);
138 #define cam_dbg(cam, fmt, arg...) \ argument
139 dev_dbg(&(cam)->platdev->dev, fmt, ##arg);
181 static int via_sensor_power_setup(struct via_camera *cam) in via_sensor_power_setup() argument
185 cam->power_gpio = viafb_gpio_lookup("VGPIO3"); in via_sensor_power_setup()
186 cam->reset_gpio = viafb_gpio_lookup("VGPIO2"); in via_sensor_power_setup()
187 if (!gpio_is_valid(cam->power_gpio) || !gpio_is_valid(cam->reset_gpio)) { in via_sensor_power_setup()
188 dev_err(&cam->platdev->dev, "Unable to find GPIO lines\n"); in via_sensor_power_setup()
191 ret = gpio_request(cam->power_gpio, "viafb-camera"); in via_sensor_power_setup()
193 dev_err(&cam->platdev->dev, "Unable to request power GPIO\n"); in via_sensor_power_setup()
196 ret = gpio_request(cam->reset_gpio, "viafb-camera"); in via_sensor_power_setup()
198 dev_err(&cam->platdev->dev, "Unable to request reset GPIO\n"); in via_sensor_power_setup()
199 gpio_free(cam->power_gpio); in via_sensor_power_setup()
202 gpio_direction_output(cam->power_gpio, 0); in via_sensor_power_setup()
203 gpio_direction_output(cam->reset_gpio, 0); in via_sensor_power_setup()
210 static void via_sensor_power_up(struct via_camera *cam) in via_sensor_power_up() argument
212 gpio_set_value(cam->power_gpio, 1); in via_sensor_power_up()
213 gpio_set_value(cam->reset_gpio, 0); in via_sensor_power_up()
215 gpio_set_value(cam->reset_gpio, 1); in via_sensor_power_up()
219 static void via_sensor_power_down(struct via_camera *cam) in via_sensor_power_down() argument
221 gpio_set_value(cam->power_gpio, 0); in via_sensor_power_down()
222 gpio_set_value(cam->reset_gpio, 0); in via_sensor_power_down()
226 static void via_sensor_power_release(struct via_camera *cam) in via_sensor_power_release() argument
228 via_sensor_power_down(cam); in via_sensor_power_release()
229 gpio_free(cam->power_gpio); in via_sensor_power_release()
230 gpio_free(cam->reset_gpio); in via_sensor_power_release()
239 static int viacam_set_flip(struct via_camera *cam) in viacam_set_flip() argument
246 return v4l2_s_ctrl(NULL, cam->sensor->ctrl_handler, &ctrl); in viacam_set_flip()
253 static int viacam_configure_sensor(struct via_camera *cam) in viacam_configure_sensor() argument
260 v4l2_fill_mbus_format(&format.format, &cam->sensor_format, cam->mbus_code); in viacam_configure_sensor()
261 ret = sensor_call(cam, core, init, 0); in viacam_configure_sensor()
263 ret = sensor_call(cam, pad, set_fmt, NULL, &format); in viacam_configure_sensor()
268 ret = viacam_set_flip(cam); in viacam_configure_sensor()
282 static inline void viacam_write_reg(struct via_camera *cam, in viacam_write_reg() argument
285 iowrite32(value, cam->mmio + reg); in viacam_write_reg()
288 static inline int viacam_read_reg(struct via_camera *cam, int reg) in viacam_read_reg() argument
290 return ioread32(cam->mmio + reg); in viacam_read_reg()
293 static inline void viacam_write_reg_mask(struct via_camera *cam, in viacam_write_reg_mask() argument
296 int tmp = viacam_read_reg(cam, reg); in viacam_write_reg_mask()
299 viacam_write_reg(cam, reg, tmp); in viacam_write_reg_mask()
308 struct via_camera *cam = data; in viacam_quick_irq() local
316 spin_lock(&cam->viadev->reg_lock); in viacam_quick_irq()
317 icv = viacam_read_reg(cam, VCR_INTCTRL); in viacam_quick_irq()
320 viacam_write_reg(cam, VCR_INTCTRL, icv); in viacam_quick_irq()
323 spin_unlock(&cam->viadev->reg_lock); in viacam_quick_irq()
330 static struct via_buffer *viacam_next_buffer(struct via_camera *cam) in viacam_next_buffer() argument
332 if (cam->opstate != S_RUNNING) in viacam_next_buffer()
334 if (list_empty(&cam->buffer_queue)) in viacam_next_buffer()
336 return list_entry(cam->buffer_queue.next, struct via_buffer, queue); in viacam_next_buffer()
344 struct via_camera *cam = data; in viacam_irq() local
349 mutex_lock(&cam->lock); in viacam_irq()
354 vb = viacam_next_buffer(cam); in viacam_irq()
360 bufn = (viacam_read_reg(cam, VCR_INTCTRL) & VCR_IC_ACTBUF) >> 3; in viacam_irq()
363 bufn = cam->n_cap_bufs - 1; in viacam_irq()
369 viafb_dma_copy_out_sg(cam->cb_offsets[bufn], sgt->sgl, sgt->nents); in viacam_irq()
370 vb->vbuf.sequence = cam->sequence++; in viacam_irq()
375 mutex_unlock(&cam->lock); in viacam_irq()
387 static void viacam_int_enable(struct via_camera *cam) in viacam_int_enable() argument
389 viacam_write_reg(cam, VCR_INTCTRL, in viacam_int_enable()
394 static void viacam_int_disable(struct via_camera *cam) in viacam_int_disable() argument
397 viacam_write_reg(cam, VCR_INTCTRL, 0); in viacam_int_disable()
408 static int viacam_ctlr_cbufs(struct via_camera *cam) in viacam_ctlr_cbufs() argument
410 int nbuf = cam->viadev->camera_fbmem_size/cam->sensor_format.sizeimage; in viacam_ctlr_cbufs()
418 cam->n_cap_bufs = 3; in viacam_ctlr_cbufs()
419 viacam_write_reg_mask(cam, VCR_CAPINTC, VCR_CI_3BUFS, in viacam_ctlr_cbufs()
422 cam->n_cap_bufs = 2; in viacam_ctlr_cbufs()
423 viacam_write_reg_mask(cam, VCR_CAPINTC, 0, VCR_CI_3BUFS); in viacam_ctlr_cbufs()
425 cam_warn(cam, "Insufficient frame buffer memory\n"); in viacam_ctlr_cbufs()
431 offset = cam->fb_offset; in viacam_ctlr_cbufs()
432 for (i = 0; i < cam->n_cap_bufs; i++) { in viacam_ctlr_cbufs()
433 cam->cb_offsets[i] = offset; in viacam_ctlr_cbufs()
434 cam->cb_addrs[i] = cam->fbmem + offset; in viacam_ctlr_cbufs()
435 viacam_write_reg(cam, VCR_VBUF1 + i*4, offset & VCR_VBUF_MASK); in viacam_ctlr_cbufs()
436 offset += cam->sensor_format.sizeimage; in viacam_ctlr_cbufs()
458 static void viacam_set_scale(struct via_camera *cam) in viacam_set_scale() argument
463 if (cam->user_format.width == VGA_WIDTH) in viacam_set_scale()
466 sf = (cam->user_format.width*2048)/VGA_WIDTH; in viacam_set_scale()
469 if (cam->user_format.height < VGA_HEIGHT) { in viacam_set_scale()
470 sf = (1024*cam->user_format.height)/VGA_HEIGHT; in viacam_set_scale()
473 viacam_write_reg(cam, VCR_AVSCALE, avscale); in viacam_set_scale()
480 static void viacam_ctlr_image(struct via_camera *cam) in viacam_ctlr_image() argument
488 viacam_write_reg(cam, VCR_CAPINTC, ~(VCR_CI_ENABLE|VCR_CI_CLKEN)); in viacam_ctlr_image()
493 viacam_write_reg(cam, VCR_HORRANGE, 0x06200120); in viacam_ctlr_image()
494 viacam_write_reg(cam, VCR_VERTRANGE, 0x01de0000); in viacam_ctlr_image()
495 viacam_set_scale(cam); in viacam_ctlr_image()
499 viacam_write_reg(cam, VCR_MAXDATA, in viacam_ctlr_image()
500 (cam->sensor_format.height << 16) | in viacam_ctlr_image()
501 (cam->sensor_format.bytesperline >> 3)); in viacam_ctlr_image()
502 viacam_write_reg(cam, VCR_MAXVBI, 0); in viacam_ctlr_image()
503 viacam_write_reg(cam, VCR_VSTRIDE, in viacam_ctlr_image()
504 cam->user_format.bytesperline & VCR_VS_STRIDE); in viacam_ctlr_image()
518 if (cam->n_cap_bufs == 3) in viacam_ctlr_image()
523 if (cam->user_format.pixelformat == V4L2_PIX_FMT_YUYV) in viacam_ctlr_image()
527 viacam_write_reg(cam, VCR_CAPINTC, cicreg); in viacam_ctlr_image()
531 static int viacam_config_controller(struct via_camera *cam) in viacam_config_controller() argument
536 spin_lock_irqsave(&cam->viadev->reg_lock, flags); in viacam_config_controller()
537 ret = viacam_ctlr_cbufs(cam); in viacam_config_controller()
539 viacam_ctlr_image(cam); in viacam_config_controller()
540 spin_unlock_irqrestore(&cam->viadev->reg_lock, flags); in viacam_config_controller()
541 clear_bit(CF_CONFIG_NEEDED, &cam->flags); in viacam_config_controller()
548 static void viacam_start_engine(struct via_camera *cam) in viacam_start_engine() argument
550 spin_lock_irq(&cam->viadev->reg_lock); in viacam_start_engine()
551 viacam_write_reg_mask(cam, VCR_CAPINTC, VCR_CI_ENABLE, VCR_CI_ENABLE); in viacam_start_engine()
552 viacam_int_enable(cam); in viacam_start_engine()
553 (void) viacam_read_reg(cam, VCR_CAPINTC); /* Force post */ in viacam_start_engine()
554 cam->opstate = S_RUNNING; in viacam_start_engine()
555 spin_unlock_irq(&cam->viadev->reg_lock); in viacam_start_engine()
559 static void viacam_stop_engine(struct via_camera *cam) in viacam_stop_engine() argument
561 spin_lock_irq(&cam->viadev->reg_lock); in viacam_stop_engine()
562 viacam_int_disable(cam); in viacam_stop_engine()
563 viacam_write_reg_mask(cam, VCR_CAPINTC, 0, VCR_CI_ENABLE); in viacam_stop_engine()
564 (void) viacam_read_reg(cam, VCR_CAPINTC); /* Force post */ in viacam_stop_engine()
565 cam->opstate = S_IDLE; in viacam_stop_engine()
566 spin_unlock_irq(&cam->viadev->reg_lock); in viacam_stop_engine()
582 struct via_camera *cam = vb2_get_drv_priv(vb->vb2_queue); in viacam_vb2_queue() local
585 list_add_tail(&via->queue, &cam->buffer_queue); in viacam_vb2_queue()
590 struct via_camera *cam = vb2_get_drv_priv(vb->vb2_queue); in viacam_vb2_prepare() local
592 if (vb2_plane_size(vb, 0) < cam->user_format.sizeimage) { in viacam_vb2_prepare()
593 cam_dbg(cam, in viacam_vb2_prepare()
596 cam->user_format.sizeimage); in viacam_vb2_prepare()
600 vb2_set_plane_payload(vb, 0, cam->user_format.sizeimage); in viacam_vb2_prepare()
610 struct via_camera *cam = vb2_get_drv_priv(vq); in viacam_vb2_queue_setup() local
611 int size = cam->user_format.sizeimage; in viacam_vb2_queue_setup()
623 struct via_camera *cam = vb2_get_drv_priv(vq); in viacam_vb2_start_streaming() local
627 if (cam->opstate != S_IDLE) { in viacam_vb2_start_streaming()
634 if (test_bit(CF_CONFIG_NEEDED, &cam->flags)) { in viacam_vb2_start_streaming()
635 ret = viacam_configure_sensor(cam); in viacam_vb2_start_streaming()
638 ret = viacam_config_controller(cam); in viacam_vb2_start_streaming()
642 cam->sequence = 0; in viacam_vb2_start_streaming()
649 cpu_latency_qos_add_request(&cam->qos_request, 50); in viacam_vb2_start_streaming()
650 viacam_start_engine(cam); in viacam_vb2_start_streaming()
653 list_for_each_entry_safe(buf, tmp, &cam->buffer_queue, queue) { in viacam_vb2_start_streaming()
662 struct via_camera *cam = vb2_get_drv_priv(vq); in viacam_vb2_stop_streaming() local
665 cpu_latency_qos_remove_request(&cam->qos_request); in viacam_vb2_stop_streaming()
666 viacam_stop_engine(cam); in viacam_vb2_stop_streaming()
668 list_for_each_entry_safe(buf, tmp, &cam->buffer_queue, queue) { in viacam_vb2_stop_streaming()
689 struct via_camera *cam = video_drvdata(filp); in viacam_open() local
696 mutex_lock(&cam->lock); in viacam_open()
707 via_sensor_power_up(cam); in viacam_open()
708 set_bit(CF_CONFIG_NEEDED, &cam->flags); in viacam_open()
711 mutex_unlock(&cam->lock); in viacam_open()
717 struct via_camera *cam = video_drvdata(filp); in viacam_release() local
720 mutex_lock(&cam->lock); in viacam_release()
727 via_sensor_power_down(cam); in viacam_release()
730 mutex_unlock(&cam->lock); in viacam_release()
842 static int viacam_do_try_fmt(struct via_camera *cam, in viacam_do_try_fmt() argument
855 ret = sensor_call(cam, pad, set_fmt, &pad_cfg, &format); in viacam_do_try_fmt()
866 struct via_camera *cam = video_drvdata(filp); in viacam_try_fmt_vid_cap() local
869 return viacam_do_try_fmt(cam, &fmt->fmt.pix, &sfmt.fmt.pix); in viacam_try_fmt_vid_cap()
876 struct via_camera *cam = video_drvdata(filp); in viacam_g_fmt_vid_cap() local
878 fmt->fmt.pix = cam->user_format; in viacam_g_fmt_vid_cap()
885 struct via_camera *cam = video_drvdata(filp); in viacam_s_fmt_vid_cap() local
894 if (cam->opstate != S_IDLE) in viacam_s_fmt_vid_cap()
900 ret = viacam_do_try_fmt(cam, &fmt->fmt.pix, &sfmt.fmt.pix); in viacam_s_fmt_vid_cap()
906 cam->user_format = fmt->fmt.pix; in viacam_s_fmt_vid_cap()
907 cam->sensor_format = sfmt.fmt.pix; in viacam_s_fmt_vid_cap()
908 cam->mbus_code = f->mbus_code; in viacam_s_fmt_vid_cap()
909 ret = viacam_configure_sensor(cam); in viacam_s_fmt_vid_cap()
911 ret = viacam_config_controller(cam); in viacam_s_fmt_vid_cap()
929 struct via_camera *cam = video_drvdata(filp); in viacam_g_parm() local
931 return v4l2_g_parm_cap(video_devdata(filp), cam->sensor, parm); in viacam_g_parm()
937 struct via_camera *cam = video_drvdata(filp); in viacam_s_parm() local
939 return v4l2_s_parm_cap(video_devdata(filp), cam->sensor, parm); in viacam_s_parm()
966 struct via_camera *cam = video_drvdata(filp); in viacam_enum_frameintervals() local
969 .code = cam->mbus_code, in viacam_enum_frameintervals()
970 .width = cam->sensor_format.width, in viacam_enum_frameintervals()
971 .height = cam->sensor_format.height, in viacam_enum_frameintervals()
985 ret = sensor_call(cam, pad, enum_frame_interval, NULL, &fie); in viacam_enum_frameintervals()
1028 struct via_camera *cam = priv; in viacam_suspend() local
1029 enum viacam_opstate state = cam->opstate; in viacam_suspend()
1031 if (cam->opstate != S_IDLE) { in viacam_suspend()
1032 viacam_stop_engine(cam); in viacam_suspend()
1033 cam->opstate = state; /* So resume restarts */ in viacam_suspend()
1041 struct via_camera *cam = priv; in viacam_resume() local
1049 viacam_int_disable(cam); in viacam_resume()
1050 set_bit(CF_CONFIG_NEEDED, &cam->flags); in viacam_resume()
1054 if (!list_empty(&cam->vdev.fh_list)) in viacam_resume()
1055 via_sensor_power_up(cam); in viacam_resume()
1057 via_sensor_power_down(cam); in viacam_resume()
1061 if (cam->opstate != S_IDLE) { in viacam_resume()
1062 mutex_lock(&cam->lock); in viacam_resume()
1063 ret = viacam_configure_sensor(cam); in viacam_resume()
1065 ret = viacam_config_controller(cam); in viacam_resume()
1066 mutex_unlock(&cam->lock); in viacam_resume()
1068 viacam_start_engine(cam); in viacam_resume()
1152 struct via_camera *cam; in viacam_probe() local
1177 cam = kzalloc (sizeof(struct via_camera), GFP_KERNEL); in viacam_probe()
1178 if (cam == NULL) in viacam_probe()
1180 via_cam_info = cam; in viacam_probe()
1181 cam->platdev = pdev; in viacam_probe()
1182 cam->viadev = viadev; in viacam_probe()
1183 cam->opstate = S_IDLE; in viacam_probe()
1184 cam->user_format = cam->sensor_format = viacam_def_pix_format; in viacam_probe()
1185 mutex_init(&cam->lock); in viacam_probe()
1186 INIT_LIST_HEAD(&cam->buffer_queue); in viacam_probe()
1187 cam->mmio = viadev->engine_mmio; in viacam_probe()
1188 cam->fbmem = viadev->fbmem; in viacam_probe()
1189 cam->fb_offset = viadev->camera_fbmem_offset; in viacam_probe()
1190 cam->flags = 1 << CF_CONFIG_NEEDED; in viacam_probe()
1191 cam->mbus_code = via_def_mbus_code; in viacam_probe()
1195 ret = v4l2_device_register(&pdev->dev, &cam->v4l2_dev); in viacam_probe()
1200 ret = v4l2_ctrl_handler_init(&cam->ctrl_handler, 10); in viacam_probe()
1203 cam->v4l2_dev.ctrl_handler = &cam->ctrl_handler; in viacam_probe()
1218 ret = via_sensor_power_setup(cam); in viacam_probe()
1221 via_sensor_power_up(cam); in viacam_probe()
1228 cam->sensor = v4l2_i2c_new_subdev_board(&cam->v4l2_dev, sensor_adapter, in viacam_probe()
1230 if (cam->sensor == NULL) { in viacam_probe()
1238 viacam_int_disable(cam); in viacam_probe()
1240 viacam_irq, IRQF_SHARED, "via-camera", cam); in viacam_probe()
1244 vq = &cam->vq; in viacam_probe()
1247 vq->drv_priv = cam; in viacam_probe()
1250 vq->dev = cam->v4l2_dev.dev; in viacam_probe()
1254 vq->lock = &cam->lock; in viacam_probe()
1260 cam->vdev = viacam_v4l_template; in viacam_probe()
1261 cam->vdev.v4l2_dev = &cam->v4l2_dev; in viacam_probe()
1262 cam->vdev.lock = &cam->lock; in viacam_probe()
1263 cam->vdev.queue = vq; in viacam_probe()
1264 video_set_drvdata(&cam->vdev, cam); in viacam_probe()
1265 ret = video_register_device(&cam->vdev, VFL_TYPE_VIDEO, -1); in viacam_probe()
1273 viacam_pm_hooks.private = cam; in viacam_probe()
1278 via_sensor_power_down(cam); in viacam_probe()
1282 free_irq(viadev->pdev->irq, cam); in viacam_probe()
1284 via_sensor_power_release(cam); in viacam_probe()
1286 v4l2_ctrl_handler_free(&cam->ctrl_handler); in viacam_probe()
1288 v4l2_device_unregister(&cam->v4l2_dev); in viacam_probe()
1290 kfree(cam); in viacam_probe()
1296 struct via_camera *cam = via_cam_info; in viacam_remove() local
1299 video_unregister_device(&cam->vdev); in viacam_remove()
1300 v4l2_device_unregister(&cam->v4l2_dev); in viacam_remove()
1304 free_irq(viadev->pdev->irq, cam); in viacam_remove()
1305 via_sensor_power_release(cam); in viacam_remove()
1306 v4l2_ctrl_handler_free(&cam->ctrl_handler); in viacam_remove()
1307 kfree(cam); in viacam_remove()