Lines Matching refs:isi
35 #include "atmel-isi.h"
135 static void isi_writel(struct atmel_isi *isi, u32 reg, u32 val)
137 writel(val, isi->regs + reg);
139 static u32 isi_readl(struct atmel_isi *isi, u32 reg)
141 return readl(isi->regs + reg);
144 static void configure_geometry(struct atmel_isi *isi)
147 u32 fourcc = isi->current_fmt->fourcc;
149 isi->enable_preview_path = fourcc == V4L2_PIX_FMT_RGB565 ||
154 cfg2 = isi->current_fmt->swap;
156 isi_writel(isi, ISI_CTRL, ISI_CTRL_DIS);
158 cfg2 |= ((isi->fmt.fmt.pix.width - 1) << ISI_CFG2_IM_HSIZE_OFFSET) &
161 cfg2 |= ((isi->fmt.fmt.pix.height - 1) << ISI_CFG2_IM_VSIZE_OFFSET)
163 isi_writel(isi, ISI_CFG2, cfg2);
166 psize = ((isi->fmt.fmt.pix.width - 1) << ISI_PSIZE_PREV_HSIZE_OFFSET) &
168 psize |= ((isi->fmt.fmt.pix.height - 1) << ISI_PSIZE_PREV_VSIZE_OFFSET) &
170 isi_writel(isi, ISI_PSIZE, psize);
171 isi_writel(isi, ISI_PDECF, ISI_PDECF_NO_SAMPLING);
174 static irqreturn_t atmel_isi_handle_streaming(struct atmel_isi *isi)
176 if (isi->active) {
177 struct vb2_v4l2_buffer *vbuf = &isi->active->vb;
178 struct frame_buffer *buf = isi->active;
182 vbuf->sequence = isi->sequence++;
187 if (list_empty(&isi->video_buffer_list)) {
188 isi->active = NULL;
191 isi->active = list_entry(isi->video_buffer_list.next,
193 if (!isi->enable_preview_path) {
194 isi_writel(isi, ISI_DMA_C_DSCR,
195 (u32)isi->active->p_dma_desc->fbd_phys);
196 isi_writel(isi, ISI_DMA_C_CTRL,
198 isi_writel(isi, ISI_DMA_CHER, ISI_DMA_CHSR_C_CH);
200 isi_writel(isi, ISI_DMA_P_DSCR,
201 (u32)isi->active->p_dma_desc->fbd_phys);
202 isi_writel(isi, ISI_DMA_P_CTRL,
204 isi_writel(isi, ISI_DMA_CHER, ISI_DMA_CHSR_P_CH);
213 struct atmel_isi *isi = dev_id;
217 spin_lock(&isi->irqlock);
219 status = isi_readl(isi, ISI_STATUS);
220 mask = isi_readl(isi, ISI_INTMASK);
224 complete(&isi->complete);
225 isi_writel(isi, ISI_INTDIS, ISI_CTRL_SRST);
228 complete(&isi->complete);
229 isi_writel(isi, ISI_INTDIS, ISI_CTRL_DIS);
234 ret = atmel_isi_handle_streaming(isi);
237 spin_unlock(&isi->irqlock);
243 static int atmel_isi_wait_status(struct atmel_isi *isi, int wait_reset)
250 init_completion(&isi->complete);
253 isi_writel(isi, ISI_INTEN, ISI_CTRL_SRST);
254 isi_writel(isi, ISI_CTRL, ISI_CTRL_SRST);
256 isi_writel(isi, ISI_INTEN, ISI_CTRL_DIS);
257 isi_writel(isi, ISI_CTRL, ISI_CTRL_DIS);
260 timeout = wait_for_completion_timeout(&isi->complete,
275 struct atmel_isi *isi = vb2_get_drv_priv(vq);
278 size = isi->fmt.fmt.pix.sizeimage;
287 isi->active = NULL;
289 dev_dbg(isi->dev, "%s, count=%d, size=%ld\n", __func__,
310 struct atmel_isi *isi = vb2_get_drv_priv(vb->vb2_queue);
314 size = isi->fmt.fmt.pix.sizeimage;
317 dev_err(isi->dev, "%s data will not fit into plane (%lu < %lu)\n",
325 if (list_empty(&isi->dma_desc_head)) {
326 dev_err(isi->dev, "Not enough dma descriptors.\n");
330 desc = list_entry(isi->dma_desc_head.next,
350 struct atmel_isi *isi = vb2_get_drv_priv(vb->vb2_queue);
355 list_add(&buf->p_dma_desc->list, &isi->dma_desc_head);
358 static void start_dma(struct atmel_isi *isi, struct frame_buffer *buffer)
362 cfg1 = isi_readl(isi, ISI_CFG1);
364 isi_writel(isi, ISI_INTEN,
368 if (!isi->enable_preview_path) {
369 if (isi_readl(isi, ISI_STATUS) & ISI_CTRL_CDC) {
370 dev_err(isi->dev, "Already in frame handling.\n");
374 isi_writel(isi, ISI_DMA_C_DSCR,
376 isi_writel(isi, ISI_DMA_C_CTRL,
378 isi_writel(isi, ISI_DMA_CHER, ISI_DMA_CHSR_C_CH);
380 isi_writel(isi, ISI_DMA_P_DSCR,
382 isi_writel(isi, ISI_DMA_P_CTRL,
384 isi_writel(isi, ISI_DMA_CHER, ISI_DMA_CHSR_P_CH);
389 cfg1 |= isi->pdata.frate | ISI_CFG1_DISCR;
394 if (!isi->enable_preview_path)
397 isi_writel(isi, ISI_CTRL, ctrl);
398 isi_writel(isi, ISI_CFG1, cfg1);
404 struct atmel_isi *isi = vb2_get_drv_priv(vb->vb2_queue);
408 spin_lock_irqsave(&isi->irqlock, flags);
409 list_add_tail(&buf->list, &isi->video_buffer_list);
411 if (!isi->active) {
412 isi->active = buf;
414 start_dma(isi, buf);
416 spin_unlock_irqrestore(&isi->irqlock, flags);
421 struct atmel_isi *isi = vb2_get_drv_priv(vq);
425 ret = pm_runtime_resume_and_get(isi->dev);
430 ret = v4l2_subdev_call(isi->entity.subdev, video, s_stream, 1);
432 dev_err(isi->dev, "stream on failed in subdev\n");
437 ret = atmel_isi_wait_status(isi, WAIT_ISI_RESET);
439 dev_err(isi->dev, "Reset ISI timed out\n");
443 isi_writel(isi, ISI_INTDIS, (u32)~0UL);
445 isi->sequence = 0;
446 configure_geometry(isi);
448 spin_lock_irq(&isi->irqlock);
450 isi_readl(isi, ISI_STATUS);
452 start_dma(isi, isi->active);
453 spin_unlock_irq(&isi->irqlock);
458 v4l2_subdev_call(isi->entity.subdev, video, s_stream, 0);
461 pm_runtime_put(isi->dev);
463 spin_lock_irq(&isi->irqlock);
464 isi->active = NULL;
466 list_for_each_entry_safe(buf, node, &isi->video_buffer_list, list) {
470 spin_unlock_irq(&isi->irqlock);
478 struct atmel_isi *isi = vb2_get_drv_priv(vq);
484 ret = v4l2_subdev_call(isi->entity.subdev, video, s_stream, 0);
486 dev_err(isi->dev, "stream off failed in subdev\n");
488 spin_lock_irq(&isi->irqlock);
489 isi->active = NULL;
491 list_for_each_entry_safe(buf, node, &isi->video_buffer_list, list) {
495 spin_unlock_irq(&isi->irqlock);
497 if (!isi->enable_preview_path) {
500 while ((isi_readl(isi, ISI_STATUS) & ISI_CTRL_CDC) &&
505 dev_err(isi->dev,
510 isi_writel(isi, ISI_INTDIS,
514 ret = atmel_isi_wait_status(isi, WAIT_ISI_DISABLE);
516 dev_err(isi->dev, "Disable ISI timed out\n");
518 pm_runtime_put(isi->dev);
536 struct atmel_isi *isi = video_drvdata(file);
538 *fmt = isi->fmt;
543 static const struct isi_format *find_format_by_fourcc(struct atmel_isi *isi,
546 unsigned int num_formats = isi->num_user_formats;
551 fmt = isi->user_formats[i];
559 static void isi_try_fse(struct atmel_isi *isi, const struct isi_format *isi_fmt,
568 ret = v4l2_subdev_call(isi->entity.subdev, pad, enum_frame_size,
583 static int isi_try_fmt(struct atmel_isi *isi, struct v4l2_format *f,
597 isi_fmt = find_format_by_fourcc(isi, pixfmt->pixelformat);
599 isi_fmt = isi->user_formats[isi->num_user_formats - 1];
609 isi_try_fse(isi, isi_fmt, &pad_state);
611 ret = v4l2_subdev_call(isi->entity.subdev, pad, set_fmt,
628 static int isi_set_fmt(struct atmel_isi *isi, struct v4l2_format *f)
636 ret = isi_try_fmt(isi, f, ¤t_fmt);
642 ret = v4l2_subdev_call(isi->entity.subdev, pad,
647 isi->fmt = *f;
648 isi->current_fmt = current_fmt;
656 struct atmel_isi *isi = video_drvdata(file);
658 if (vb2_is_streaming(&isi->queue))
661 return isi_set_fmt(isi, f);
667 struct atmel_isi *isi = video_drvdata(file);
669 return isi_try_fmt(isi, f, NULL);
675 struct atmel_isi *isi = video_drvdata(file);
677 if (f->index >= isi->num_user_formats)
680 f->pixelformat = isi->user_formats[f->index]->fourcc;
687 strscpy(cap->driver, "atmel-isi", sizeof(cap->driver));
689 strscpy(cap->bus_info, "platform:isi", sizeof(cap->bus_info));
719 struct atmel_isi *isi = video_drvdata(file);
721 return v4l2_g_parm_cap(video_devdata(file), isi->entity.subdev, a);
726 struct atmel_isi *isi = video_drvdata(file);
728 return v4l2_s_parm_cap(video_devdata(file), isi->entity.subdev, a);
734 struct atmel_isi *isi = video_drvdata(file);
742 isi_fmt = find_format_by_fourcc(isi, fsize->pixel_format);
748 ret = v4l2_subdev_call(isi->entity.subdev, pad, enum_frame_size,
763 struct atmel_isi *isi = video_drvdata(file);
773 isi_fmt = find_format_by_fourcc(isi, fival->pixel_format);
779 ret = v4l2_subdev_call(isi->entity.subdev, pad,
790 static int isi_camera_set_bus_param(struct atmel_isi *isi)
796 if (isi->pdata.hsync_act_low)
798 if (isi->pdata.vsync_act_low)
800 if (isi->pdata.pclk_act_falling)
802 if (isi->pdata.has_emb_sync)
804 if (isi->pdata.full_mode)
809 /* Enable PM and peripheral clock before operate isi registers */
810 ret = pm_runtime_resume_and_get(isi->dev);
814 isi_writel(isi, ISI_CTRL, ISI_CTRL_DIS);
815 isi_writel(isi, ISI_CFG1, cfg1);
817 pm_runtime_put(isi->dev);
823 static int atmel_isi_parse_dt(struct atmel_isi *isi,
831 isi->pdata.full_mode = 1;
832 isi->pdata.frate = ISI_CFG1_FRATE_CAPTURE_ALL;
849 isi->pdata.data_width_flags = ISI_DATAWIDTH_8;
852 isi->pdata.data_width_flags =
862 isi->pdata.hsync_act_low = true;
864 isi->pdata.vsync_act_low = true;
866 isi->pdata.pclk_act_falling = true;
869 isi->pdata.has_emb_sync = true;
876 struct atmel_isi *isi = video_drvdata(file);
877 struct v4l2_subdev *sd = isi->entity.subdev;
880 if (mutex_lock_interruptible(&isi->lock))
894 ret = isi_set_fmt(isi, &isi->fmt);
901 mutex_unlock(&isi->lock);
907 struct atmel_isi *isi = video_drvdata(file);
908 struct v4l2_subdev *sd = isi->entity.subdev;
912 mutex_lock(&isi->lock);
921 mutex_unlock(&isi->lock);
968 static int isi_set_default_fmt(struct atmel_isi *isi)
976 .pixelformat = isi->user_formats[0]->fourcc,
981 ret = isi_try_fmt(isi, &f, NULL);
984 isi->current_fmt = isi->user_formats[0];
985 isi->fmt = f;
1043 static int isi_formats_init(struct atmel_isi *isi)
1047 struct v4l2_subdev *subdev = isi->entity.subdev;
1073 isi->num_user_formats = num_fmts;
1074 isi->user_formats = devm_kcalloc(isi->dev,
1077 if (!isi->user_formats)
1080 memcpy(isi->user_formats, isi_fmts,
1082 isi->current_fmt = isi->user_formats[0];
1089 struct atmel_isi *isi = notifier_to_isi(notifier);
1092 isi->vdev->ctrl_handler = isi->entity.subdev->ctrl_handler;
1093 ret = isi_formats_init(isi);
1095 dev_err(isi->dev, "No supported mediabus format found\n");
1098 ret = isi_camera_set_bus_param(isi);
1100 dev_err(isi->dev, "Can't wake up device\n");
1104 ret = isi_set_default_fmt(isi);
1106 dev_err(isi->dev, "Could not set default format\n");
1110 ret = video_register_device(isi->vdev, VFL_TYPE_VIDEO, -1);
1112 dev_err(isi->dev, "Failed to register video device\n");
1116 dev_dbg(isi->dev, "Device registered as %s\n",
1117 video_device_node_name(isi->vdev));
1125 struct atmel_isi *isi = notifier_to_isi(notifier);
1127 dev_dbg(isi->dev, "Removing %s\n", video_device_node_name(isi->vdev));
1130 video_unregister_device(isi->vdev);
1137 struct atmel_isi *isi = notifier_to_isi(notifier);
1139 dev_dbg(isi->dev, "subdev %s bound\n", subdev->name);
1141 isi->entity.subdev = subdev;
1152 static int isi_graph_init(struct atmel_isi *isi)
1158 ep = of_graph_get_next_endpoint(isi->dev->of_node, NULL);
1162 v4l2_async_nf_init(&isi->notifier, &isi->v4l2_dev);
1164 asd = v4l2_async_nf_add_fwnode_remote(&isi->notifier,
1172 isi->notifier.ops = &isi_graph_notify_ops;
1174 ret = v4l2_async_nf_register(&isi->notifier);
1176 dev_err(isi->dev, "Notifier registration failed\n");
1177 v4l2_async_nf_cleanup(&isi->notifier);
1188 struct atmel_isi *isi;
1192 isi = devm_kzalloc(&pdev->dev, sizeof(struct atmel_isi), GFP_KERNEL);
1193 if (!isi)
1196 isi->pclk = devm_clk_get(&pdev->dev, "isi_clk");
1197 if (IS_ERR(isi->pclk))
1198 return PTR_ERR(isi->pclk);
1200 ret = atmel_isi_parse_dt(isi, pdev);
1204 isi->active = NULL;
1205 isi->dev = &pdev->dev;
1206 mutex_init(&isi->lock);
1207 spin_lock_init(&isi->irqlock);
1208 INIT_LIST_HEAD(&isi->video_buffer_list);
1209 INIT_LIST_HEAD(&isi->dma_desc_head);
1211 q = &isi->queue;
1214 ret = v4l2_device_register(&pdev->dev, &isi->v4l2_dev);
1218 isi->vdev = video_device_alloc();
1219 if (!isi->vdev) {
1225 isi->vdev->fops = &isi_fops;
1226 isi->vdev->v4l2_dev = &isi->v4l2_dev;
1227 isi->vdev->queue = &isi->queue;
1228 strscpy(isi->vdev->name, KBUILD_MODNAME, sizeof(isi->vdev->name));
1229 isi->vdev->release = video_device_release;
1230 isi->vdev->ioctl_ops = &isi_ioctl_ops;
1231 isi->vdev->lock = &isi->lock;
1232 isi->vdev->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING |
1234 video_set_drvdata(isi->vdev, isi);
1239 q->lock = &isi->lock;
1240 q->drv_priv = isi;
1253 isi->p_fb_descriptors = dma_alloc_coherent(&pdev->dev,
1255 &isi->fb_descriptors_phys,
1257 if (!isi->p_fb_descriptors) {
1264 isi->dma_desc[i].p_fbd = isi->p_fb_descriptors + i;
1265 isi->dma_desc[i].fbd_phys = isi->fb_descriptors_phys +
1267 list_add(&isi->dma_desc[i].list, &isi->dma_desc_head);
1270 isi->regs = devm_platform_ioremap_resource(pdev, 0);
1271 if (IS_ERR(isi->regs)) {
1272 ret = PTR_ERR(isi->regs);
1276 if (isi->pdata.data_width_flags & ISI_DATAWIDTH_8)
1277 isi->width_flags = 1 << 7;
1278 if (isi->pdata.data_width_flags & ISI_DATAWIDTH_10)
1279 isi->width_flags |= 1 << 9;
1287 ret = devm_request_irq(&pdev->dev, irq, isi_interrupt, 0, "isi", isi);
1292 isi->irq = irq;
1294 ret = isi_graph_init(isi);
1300 platform_set_drvdata(pdev, isi);
1307 isi->p_fb_descriptors,
1308 isi->fb_descriptors_phys);
1311 video_device_release(isi->vdev);
1313 v4l2_device_unregister(&isi->v4l2_dev);
1320 struct atmel_isi *isi = platform_get_drvdata(pdev);
1324 isi->p_fb_descriptors,
1325 isi->fb_descriptors_phys);
1327 v4l2_async_nf_unregister(&isi->notifier);
1328 v4l2_async_nf_cleanup(&isi->notifier);
1329 v4l2_device_unregister(&isi->v4l2_dev);
1335 struct atmel_isi *isi = dev_get_drvdata(dev);
1337 clk_disable_unprepare(isi->pclk);
1343 struct atmel_isi *isi = dev_get_drvdata(dev);
1345 return clk_prepare_enable(isi->pclk);
1355 { .compatible = "atmel,at91sam9g45-isi" },