Lines Matching refs:isi
35 #include "atmel-isi.h"
136 static void isi_writel(struct atmel_isi *isi, u32 reg, u32 val)
138 writel(val, isi->regs + reg);
140 static u32 isi_readl(struct atmel_isi *isi, u32 reg)
142 return readl(isi->regs + reg);
145 static void configure_geometry(struct atmel_isi *isi)
148 u32 fourcc = isi->current_fmt->fourcc;
150 isi->enable_preview_path = fourcc == V4L2_PIX_FMT_RGB565 ||
155 cfg2 = isi->current_fmt->swap;
157 isi_writel(isi, ISI_CTRL, ISI_CTRL_DIS);
159 cfg2 |= ((isi->fmt.fmt.pix.width - 1) << ISI_CFG2_IM_HSIZE_OFFSET) &
162 cfg2 |= ((isi->fmt.fmt.pix.height - 1) << ISI_CFG2_IM_VSIZE_OFFSET)
164 isi_writel(isi, ISI_CFG2, cfg2);
167 psize = ((isi->fmt.fmt.pix.width - 1) << ISI_PSIZE_PREV_HSIZE_OFFSET) &
169 psize |= ((isi->fmt.fmt.pix.height - 1) << ISI_PSIZE_PREV_VSIZE_OFFSET) &
171 isi_writel(isi, ISI_PSIZE, psize);
172 isi_writel(isi, ISI_PDECF, ISI_PDECF_NO_SAMPLING);
175 static irqreturn_t atmel_isi_handle_streaming(struct atmel_isi *isi)
177 if (isi->active) {
178 struct vb2_v4l2_buffer *vbuf = &isi->active->vb;
179 struct frame_buffer *buf = isi->active;
183 vbuf->sequence = isi->sequence++;
188 if (list_empty(&isi->video_buffer_list)) {
189 isi->active = NULL;
192 isi->active = list_entry(isi->video_buffer_list.next,
194 if (!isi->enable_preview_path) {
195 isi_writel(isi, ISI_DMA_C_DSCR,
196 (u32)isi->active->p_dma_desc->fbd_phys);
197 isi_writel(isi, ISI_DMA_C_CTRL,
199 isi_writel(isi, ISI_DMA_CHER, ISI_DMA_CHSR_C_CH);
201 isi_writel(isi, ISI_DMA_P_DSCR,
202 (u32)isi->active->p_dma_desc->fbd_phys);
203 isi_writel(isi, ISI_DMA_P_CTRL,
205 isi_writel(isi, ISI_DMA_CHER, ISI_DMA_CHSR_P_CH);
214 struct atmel_isi *isi = dev_id;
218 spin_lock(&isi->irqlock);
220 status = isi_readl(isi, ISI_STATUS);
221 mask = isi_readl(isi, ISI_INTMASK);
225 complete(&isi->complete);
226 isi_writel(isi, ISI_INTDIS, ISI_CTRL_SRST);
229 complete(&isi->complete);
230 isi_writel(isi, ISI_INTDIS, ISI_CTRL_DIS);
235 ret = atmel_isi_handle_streaming(isi);
238 spin_unlock(&isi->irqlock);
244 static int atmel_isi_wait_status(struct atmel_isi *isi, int wait_reset)
251 init_completion(&isi->complete);
254 isi_writel(isi, ISI_INTEN, ISI_CTRL_SRST);
255 isi_writel(isi, ISI_CTRL, ISI_CTRL_SRST);
257 isi_writel(isi, ISI_INTEN, ISI_CTRL_DIS);
258 isi_writel(isi, ISI_CTRL, ISI_CTRL_DIS);
261 timeout = wait_for_completion_timeout(&isi->complete,
276 struct atmel_isi *isi = vb2_get_drv_priv(vq);
279 size = isi->fmt.fmt.pix.sizeimage;
288 isi->active = NULL;
290 dev_dbg(isi->dev, "%s, count=%d, size=%ld\n", __func__,
311 struct atmel_isi *isi = vb2_get_drv_priv(vb->vb2_queue);
315 size = isi->fmt.fmt.pix.sizeimage;
318 dev_err(isi->dev, "%s data will not fit into plane (%lu < %lu)\n",
326 if (list_empty(&isi->dma_desc_head)) {
327 dev_err(isi->dev, "Not enough dma descriptors.\n");
331 desc = list_entry(isi->dma_desc_head.next,
351 struct atmel_isi *isi = vb2_get_drv_priv(vb->vb2_queue);
356 list_add(&buf->p_dma_desc->list, &isi->dma_desc_head);
359 static void start_dma(struct atmel_isi *isi, struct frame_buffer *buffer)
363 cfg1 = isi_readl(isi, ISI_CFG1);
365 isi_writel(isi, ISI_INTEN,
369 if (!isi->enable_preview_path) {
370 if (isi_readl(isi, ISI_STATUS) & ISI_CTRL_CDC) {
371 dev_err(isi->dev, "Already in frame handling.\n");
375 isi_writel(isi, ISI_DMA_C_DSCR,
377 isi_writel(isi, ISI_DMA_C_CTRL,
379 isi_writel(isi, ISI_DMA_CHER, ISI_DMA_CHSR_C_CH);
381 isi_writel(isi, ISI_DMA_P_DSCR,
383 isi_writel(isi, ISI_DMA_P_CTRL,
385 isi_writel(isi, ISI_DMA_CHER, ISI_DMA_CHSR_P_CH);
390 cfg1 |= isi->pdata.frate | ISI_CFG1_DISCR;
395 if (!isi->enable_preview_path)
398 isi_writel(isi, ISI_CTRL, ctrl);
399 isi_writel(isi, ISI_CFG1, cfg1);
405 struct atmel_isi *isi = vb2_get_drv_priv(vb->vb2_queue);
409 spin_lock_irqsave(&isi->irqlock, flags);
410 list_add_tail(&buf->list, &isi->video_buffer_list);
412 if (!isi->active) {
413 isi->active = buf;
415 start_dma(isi, buf);
417 spin_unlock_irqrestore(&isi->irqlock, flags);
422 struct atmel_isi *isi = vb2_get_drv_priv(vq);
426 pm_runtime_get_sync(isi->dev);
429 ret = v4l2_subdev_call(isi->entity.subdev, video, s_stream, 1);
431 dev_err(isi->dev, "stream on failed in subdev\n");
436 ret = atmel_isi_wait_status(isi, WAIT_ISI_RESET);
438 dev_err(isi->dev, "Reset ISI timed out\n");
442 isi_writel(isi, ISI_INTDIS, (u32)~0UL);
444 isi->sequence = 0;
445 configure_geometry(isi);
447 spin_lock_irq(&isi->irqlock);
449 isi_readl(isi, ISI_STATUS);
451 start_dma(isi, isi->active);
452 spin_unlock_irq(&isi->irqlock);
457 v4l2_subdev_call(isi->entity.subdev, video, s_stream, 0);
460 pm_runtime_put(isi->dev);
462 spin_lock_irq(&isi->irqlock);
463 isi->active = NULL;
465 list_for_each_entry_safe(buf, node, &isi->video_buffer_list, list) {
469 spin_unlock_irq(&isi->irqlock);
477 struct atmel_isi *isi = vb2_get_drv_priv(vq);
483 ret = v4l2_subdev_call(isi->entity.subdev, video, s_stream, 0);
485 dev_err(isi->dev, "stream off failed in subdev\n");
487 spin_lock_irq(&isi->irqlock);
488 isi->active = NULL;
490 list_for_each_entry_safe(buf, node, &isi->video_buffer_list, list) {
494 spin_unlock_irq(&isi->irqlock);
496 if (!isi->enable_preview_path) {
499 while ((isi_readl(isi, ISI_STATUS) & ISI_CTRL_CDC) &&
504 dev_err(isi->dev,
509 isi_writel(isi, ISI_INTDIS,
513 ret = atmel_isi_wait_status(isi, WAIT_ISI_DISABLE);
515 dev_err(isi->dev, "Disable ISI timed out\n");
517 pm_runtime_put(isi->dev);
535 struct atmel_isi *isi = video_drvdata(file);
537 *fmt = isi->fmt;
542 static const struct isi_format *find_format_by_fourcc(struct atmel_isi *isi,
545 unsigned int num_formats = isi->num_user_formats;
550 fmt = isi->user_formats[i];
558 static void isi_try_fse(struct atmel_isi *isi, const struct isi_format *isi_fmt,
567 ret = v4l2_subdev_call(isi->entity.subdev, pad, enum_frame_size,
582 static int isi_try_fmt(struct atmel_isi *isi, struct v4l2_format *f,
593 isi_fmt = find_format_by_fourcc(isi, pixfmt->pixelformat);
595 isi_fmt = isi->user_formats[isi->num_user_formats - 1];
605 isi_try_fse(isi, isi_fmt, &pad_cfg);
607 ret = v4l2_subdev_call(isi->entity.subdev, pad, set_fmt,
624 static int isi_set_fmt(struct atmel_isi *isi, struct v4l2_format *f)
632 ret = isi_try_fmt(isi, f, ¤t_fmt);
638 ret = v4l2_subdev_call(isi->entity.subdev, pad,
643 isi->fmt = *f;
644 isi->current_fmt = current_fmt;
652 struct atmel_isi *isi = video_drvdata(file);
654 if (vb2_is_streaming(&isi->queue))
657 return isi_set_fmt(isi, f);
663 struct atmel_isi *isi = video_drvdata(file);
665 return isi_try_fmt(isi, f, NULL);
671 struct atmel_isi *isi = video_drvdata(file);
673 if (f->index >= isi->num_user_formats)
676 f->pixelformat = isi->user_formats[f->index]->fourcc;
683 strscpy(cap->driver, "atmel-isi", sizeof(cap->driver));
685 strscpy(cap->bus_info, "platform:isi", sizeof(cap->bus_info));
715 struct atmel_isi *isi = video_drvdata(file);
717 return v4l2_g_parm_cap(video_devdata(file), isi->entity.subdev, a);
722 struct atmel_isi *isi = video_drvdata(file);
724 return v4l2_s_parm_cap(video_devdata(file), isi->entity.subdev, a);
730 struct atmel_isi *isi = video_drvdata(file);
738 isi_fmt = find_format_by_fourcc(isi, fsize->pixel_format);
744 ret = v4l2_subdev_call(isi->entity.subdev, pad, enum_frame_size,
759 struct atmel_isi *isi = video_drvdata(file);
769 isi_fmt = find_format_by_fourcc(isi, fival->pixel_format);
775 ret = v4l2_subdev_call(isi->entity.subdev, pad,
786 static void isi_camera_set_bus_param(struct atmel_isi *isi)
791 if (isi->pdata.hsync_act_low)
793 if (isi->pdata.vsync_act_low)
795 if (isi->pdata.pclk_act_falling)
797 if (isi->pdata.has_emb_sync)
799 if (isi->pdata.full_mode)
804 /* Enable PM and peripheral clock before operate isi registers */
805 pm_runtime_get_sync(isi->dev);
807 isi_writel(isi, ISI_CTRL, ISI_CTRL_DIS);
808 isi_writel(isi, ISI_CFG1, cfg1);
810 pm_runtime_put(isi->dev);
814 static int atmel_isi_parse_dt(struct atmel_isi *isi,
822 isi->pdata.full_mode = 1;
823 isi->pdata.frate = ISI_CFG1_FRATE_CAPTURE_ALL;
840 isi->pdata.data_width_flags = ISI_DATAWIDTH_8;
843 isi->pdata.data_width_flags =
853 isi->pdata.hsync_act_low = true;
855 isi->pdata.vsync_act_low = true;
857 isi->pdata.pclk_act_falling = true;
860 isi->pdata.has_emb_sync = true;
867 struct atmel_isi *isi = video_drvdata(file);
868 struct v4l2_subdev *sd = isi->entity.subdev;
871 if (mutex_lock_interruptible(&isi->lock))
885 ret = isi_set_fmt(isi, &isi->fmt);
892 mutex_unlock(&isi->lock);
898 struct atmel_isi *isi = video_drvdata(file);
899 struct v4l2_subdev *sd = isi->entity.subdev;
903 mutex_lock(&isi->lock);
912 mutex_unlock(&isi->lock);
959 static int isi_set_default_fmt(struct atmel_isi *isi)
967 .pixelformat = isi->user_formats[0]->fourcc,
972 ret = isi_try_fmt(isi, &f, NULL);
975 isi->current_fmt = isi->user_formats[0];
976 isi->fmt = f;
1034 static int isi_formats_init(struct atmel_isi *isi)
1038 struct v4l2_subdev *subdev = isi->entity.subdev;
1064 isi->num_user_formats = num_fmts;
1065 isi->user_formats = devm_kcalloc(isi->dev,
1068 if (!isi->user_formats)
1071 memcpy(isi->user_formats, isi_fmts,
1073 isi->current_fmt = isi->user_formats[0];
1080 struct atmel_isi *isi = notifier_to_isi(notifier);
1083 isi->vdev->ctrl_handler = isi->entity.subdev->ctrl_handler;
1084 ret = isi_formats_init(isi);
1086 dev_err(isi->dev, "No supported mediabus format found\n");
1089 isi_camera_set_bus_param(isi);
1091 ret = isi_set_default_fmt(isi);
1093 dev_err(isi->dev, "Could not set default format\n");
1097 ret = video_register_device(isi->vdev, VFL_TYPE_VIDEO, -1);
1099 dev_err(isi->dev, "Failed to register video device\n");
1103 dev_dbg(isi->dev, "Device registered as %s\n",
1104 video_device_node_name(isi->vdev));
1112 struct atmel_isi *isi = notifier_to_isi(notifier);
1114 dev_dbg(isi->dev, "Removing %s\n", video_device_node_name(isi->vdev));
1117 video_unregister_device(isi->vdev);
1124 struct atmel_isi *isi = notifier_to_isi(notifier);
1126 dev_dbg(isi->dev, "subdev %s bound\n", subdev->name);
1128 isi->entity.subdev = subdev;
1139 static int isi_graph_parse(struct atmel_isi *isi, struct device_node *node)
1154 isi->entity.node = remote;
1155 isi->entity.asd.match_type = V4L2_ASYNC_MATCH_FWNODE;
1156 isi->entity.asd.match.fwnode = of_fwnode_handle(remote);
1160 static int isi_graph_init(struct atmel_isi *isi)
1165 ret = isi_graph_parse(isi, isi->dev->of_node);
1167 dev_err(isi->dev, "Graph parsing failed\n");
1171 v4l2_async_notifier_init(&isi->notifier);
1173 ret = v4l2_async_notifier_add_subdev(&isi->notifier, &isi->entity.asd);
1175 of_node_put(isi->entity.node);
1179 isi->notifier.ops = &isi_graph_notify_ops;
1181 ret = v4l2_async_notifier_register(&isi->v4l2_dev, &isi->notifier);
1183 dev_err(isi->dev, "Notifier registration failed\n");
1184 v4l2_async_notifier_cleanup(&isi->notifier);
1195 struct atmel_isi *isi;
1200 isi = devm_kzalloc(&pdev->dev, sizeof(struct atmel_isi), GFP_KERNEL);
1201 if (!isi)
1204 isi->pclk = devm_clk_get(&pdev->dev, "isi_clk");
1205 if (IS_ERR(isi->pclk))
1206 return PTR_ERR(isi->pclk);
1208 ret = atmel_isi_parse_dt(isi, pdev);
1212 isi->active = NULL;
1213 isi->dev = &pdev->dev;
1214 mutex_init(&isi->lock);
1215 spin_lock_init(&isi->irqlock);
1216 INIT_LIST_HEAD(&isi->video_buffer_list);
1217 INIT_LIST_HEAD(&isi->dma_desc_head);
1219 q = &isi->queue;
1222 ret = v4l2_device_register(&pdev->dev, &isi->v4l2_dev);
1226 isi->vdev = video_device_alloc();
1227 if (!isi->vdev) {
1233 isi->vdev->fops = &isi_fops;
1234 isi->vdev->v4l2_dev = &isi->v4l2_dev;
1235 isi->vdev->queue = &isi->queue;
1236 strscpy(isi->vdev->name, KBUILD_MODNAME, sizeof(isi->vdev->name));
1237 isi->vdev->release = video_device_release;
1238 isi->vdev->ioctl_ops = &isi_ioctl_ops;
1239 isi->vdev->lock = &isi->lock;
1240 isi->vdev->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING |
1242 video_set_drvdata(isi->vdev, isi);
1247 q->lock = &isi->lock;
1248 q->drv_priv = isi;
1261 isi->p_fb_descriptors = dma_alloc_coherent(&pdev->dev,
1263 &isi->fb_descriptors_phys,
1265 if (!isi->p_fb_descriptors) {
1272 isi->dma_desc[i].p_fbd = isi->p_fb_descriptors + i;
1273 isi->dma_desc[i].fbd_phys = isi->fb_descriptors_phys +
1275 list_add(&isi->dma_desc[i].list, &isi->dma_desc_head);
1279 isi->regs = devm_ioremap_resource(&pdev->dev, regs);
1280 if (IS_ERR(isi->regs)) {
1281 ret = PTR_ERR(isi->regs);
1285 if (isi->pdata.data_width_flags & ISI_DATAWIDTH_8)
1286 isi->width_flags = 1 << 7;
1287 if (isi->pdata.data_width_flags & ISI_DATAWIDTH_10)
1288 isi->width_flags |= 1 << 9;
1296 ret = devm_request_irq(&pdev->dev, irq, isi_interrupt, 0, "isi", isi);
1301 isi->irq = irq;
1303 ret = isi_graph_init(isi);
1309 platform_set_drvdata(pdev, isi);
1316 isi->p_fb_descriptors,
1317 isi->fb_descriptors_phys);
1320 video_device_release(isi->vdev);
1322 v4l2_device_unregister(&isi->v4l2_dev);
1329 struct atmel_isi *isi = platform_get_drvdata(pdev);
1333 isi->p_fb_descriptors,
1334 isi->fb_descriptors_phys);
1336 v4l2_async_notifier_unregister(&isi->notifier);
1337 v4l2_async_notifier_cleanup(&isi->notifier);
1338 v4l2_device_unregister(&isi->v4l2_dev);
1346 struct atmel_isi *isi = dev_get_drvdata(dev);
1348 clk_disable_unprepare(isi->pclk);
1354 struct atmel_isi *isi = dev_get_drvdata(dev);
1356 return clk_prepare_enable(isi->pclk);
1366 { .compatible = "atmel,at91sam9g45-isi" },