Lines Matching defs:isp
3 * isp.c
68 #include "isp.h"
82 static void isp_save_ctx(struct isp_device *isp);
84 static void isp_restore_ctx(struct isp_device *isp);
139 * @isp: OMAP3 ISP device
147 void omap3isp_flush(struct isp_device *isp)
149 isp_reg_writel(isp, 0, OMAP3_ISP_IOMEM_MAIN, ISP_REVISION);
150 isp_reg_readl(isp, OMAP3_ISP_IOMEM_MAIN, ISP_REVISION);
163 isp_reg_clr_set(xclk->isp, OMAP3_ISP_IOMEM_MAIN, ISP_TCTRL_CTRL,
168 isp_reg_clr_set(xclk->isp, OMAP3_ISP_IOMEM_MAIN, ISP_TCTRL_CTRL,
179 omap3isp_get(xclk->isp);
188 omap3isp_put(xclk->isp);
267 dev_dbg(xclk->isp->dev, "%s: cam_xclk%c set to %lu Hz (div %u)\n",
287 struct isp_device *isp = data;
289 if (idx >= ARRAY_SIZE(isp->xclks))
292 return isp->xclks[idx].clk;
295 static int isp_xclk_init(struct isp_device *isp)
297 struct device_node *np = isp->dev->of_node;
301 for (i = 0; i < ARRAY_SIZE(isp->xclks); ++i)
302 isp->xclks[i].clk = ERR_PTR(-EINVAL);
304 for (i = 0; i < ARRAY_SIZE(isp->xclks); ++i) {
305 struct isp_xclk *xclk = &isp->xclks[i];
307 xclk->isp = isp;
330 of_clk_add_provider(np, isp_xclk_src_get, isp);
335 static void isp_xclk_cleanup(struct isp_device *isp)
337 struct device_node *np = isp->dev->of_node;
343 for (i = 0; i < ARRAY_SIZE(isp->xclks); ++i) {
344 struct isp_xclk *xclk = &isp->xclks[i];
357 * @isp: OMAP3 ISP device
359 static void isp_enable_interrupts(struct isp_device *isp)
374 isp_reg_writel(isp, irq, OMAP3_ISP_IOMEM_MAIN, ISP_IRQ0STATUS);
375 isp_reg_writel(isp, irq, OMAP3_ISP_IOMEM_MAIN, ISP_IRQ0ENABLE);
380 * @isp: OMAP3 ISP device
382 static void isp_disable_interrupts(struct isp_device *isp)
384 isp_reg_writel(isp, 0, OMAP3_ISP_IOMEM_MAIN, ISP_IRQ0ENABLE);
389 * @isp: OMAP3 ISP device
399 static void isp_core_init(struct isp_device *isp, int idle)
401 isp_reg_writel(isp,
405 ((isp->revision == ISP_REVISION_15_0) ?
409 isp_reg_writel(isp,
410 (isp->autoidle ? ISPCTRL_SBL_AUTOIDLE : 0) |
426 void omap3isp_configure_bridge(struct isp_device *isp,
433 ispctrl_val = isp_reg_readl(isp, OMAP3_ISP_IOMEM_MAIN, ISP_CTRL);
465 isp_reg_writel(isp, ispctrl_val, OMAP3_ISP_IOMEM_MAIN, ISP_CTRL);
468 void omap3isp_hist_dma_done(struct isp_device *isp)
470 if (omap3isp_ccdc_busy(&isp->isp_ccdc) ||
471 omap3isp_stat_pcr_busy(&isp->isp_hist)) {
473 atomic_set(&isp->isp_hist.buf_err, 1);
474 dev_dbg(isp->dev,
479 static inline void isp_isr_dbg(struct isp_device *isp, u32 irqstatus)
517 dev_dbg(isp->dev, "ISP IRQ: ");
526 static void isp_isr_sbl(struct isp_device *isp)
528 struct device *dev = isp->dev;
536 sbl_pcr = isp_reg_readl(isp, OMAP3_ISP_IOMEM_SBL, ISPSBL_PCR);
537 isp_reg_writel(isp, sbl_pcr, OMAP3_ISP_IOMEM_SBL, ISPSBL_PCR);
544 pipe = to_isp_pipeline(&isp->isp_ccp2.subdev.entity);
550 pipe = to_isp_pipeline(&isp->isp_csi2a.subdev.entity);
556 pipe = to_isp_pipeline(&isp->isp_ccdc.subdev.entity);
562 pipe = to_isp_pipeline(&isp->isp_prev.subdev.entity);
571 pipe = to_isp_pipeline(&isp->isp_res.subdev.entity);
577 omap3isp_stat_sbl_overflow(&isp->isp_af);
580 omap3isp_stat_sbl_overflow(&isp->isp_aewb);
597 struct isp_device *isp = _isp;
600 irqstatus = isp_reg_readl(isp, OMAP3_ISP_IOMEM_MAIN, ISP_IRQ0STATUS);
601 isp_reg_writel(isp, irqstatus, OMAP3_ISP_IOMEM_MAIN, ISP_IRQ0STATUS);
603 isp_isr_sbl(isp);
606 omap3isp_csi2_isr(&isp->isp_csi2a);
609 omap3isp_ccp2_isr(&isp->isp_ccp2);
612 if (isp->isp_ccdc.output & CCDC_OUTPUT_PREVIEW)
613 omap3isp_preview_isr_frame_sync(&isp->isp_prev);
614 if (isp->isp_ccdc.output & CCDC_OUTPUT_RESIZER)
615 omap3isp_resizer_isr_frame_sync(&isp->isp_res);
616 omap3isp_stat_isr_frame_sync(&isp->isp_aewb);
617 omap3isp_stat_isr_frame_sync(&isp->isp_af);
618 omap3isp_stat_isr_frame_sync(&isp->isp_hist);
622 omap3isp_ccdc_isr(&isp->isp_ccdc, irqstatus & ccdc_events);
625 if (isp->isp_prev.output & PREVIEW_OUTPUT_RESIZER)
626 omap3isp_resizer_isr_frame_sync(&isp->isp_res);
627 omap3isp_preview_isr(&isp->isp_prev);
631 omap3isp_resizer_isr(&isp->isp_res);
634 omap3isp_stat_isr(&isp->isp_aewb);
637 omap3isp_stat_isr(&isp->isp_af);
640 omap3isp_stat_isr(&isp->isp_hist);
642 omap3isp_flush(isp);
645 isp_isr_dbg(isp, irqstatus);
673 struct isp_device *isp = pipe->output->isp;
685 if (media_entity_enum_intersects(&pipe->ent_enum, &isp->crashed))
711 if (subdev == &isp->isp_ccdc.subdev) {
712 v4l2_subdev_call(&isp->isp_aewb.subdev, video,
714 v4l2_subdev_call(&isp->isp_af.subdev, video,
716 v4l2_subdev_call(&isp->isp_hist.subdev, video,
722 if (subdev->dev != isp->dev)
729 static int isp_pipeline_wait_resizer(struct isp_device *isp)
731 return omap3isp_resizer_busy(&isp->isp_res);
734 static int isp_pipeline_wait_preview(struct isp_device *isp)
736 return omap3isp_preview_busy(&isp->isp_prev);
739 static int isp_pipeline_wait_ccdc(struct isp_device *isp)
741 return omap3isp_stat_busy(&isp->isp_af)
742 || omap3isp_stat_busy(&isp->isp_aewb)
743 || omap3isp_stat_busy(&isp->isp_hist)
744 || omap3isp_ccdc_busy(&isp->isp_ccdc);
749 static int isp_pipeline_wait(struct isp_device *isp,
750 int(*busy)(struct isp_device *isp))
755 if (!busy(isp))
776 struct isp_device *isp = pipe->output->isp;
800 if (subdev == &isp->isp_ccdc.subdev) {
801 v4l2_subdev_call(&isp->isp_aewb.subdev,
803 v4l2_subdev_call(&isp->isp_af.subdev,
805 v4l2_subdev_call(&isp->isp_hist.subdev,
812 if (subdev->dev != isp->dev)
815 if (subdev == &isp->isp_res.subdev)
816 ret |= isp_pipeline_wait(isp, isp_pipeline_wait_resizer);
817 else if (subdev == &isp->isp_prev.subdev)
818 ret |= isp_pipeline_wait(isp, isp_pipeline_wait_preview);
819 else if (subdev == &isp->isp_ccdc.subdev)
820 ret |= isp_pipeline_wait(isp, isp_pipeline_wait_ccdc);
835 dev_info(isp->dev, "Unable to stop %s\n", subdev->name);
836 isp->stop_failure = true;
837 if (subdev == &isp->isp_prev.subdev)
838 media_entity_enum_set(&isp->crashed,
972 * @isp: OMAP3 ISP device
977 static int __maybe_unused isp_suspend_modules(struct isp_device *isp)
981 omap3isp_stat_suspend(&isp->isp_aewb);
982 omap3isp_stat_suspend(&isp->isp_af);
983 omap3isp_stat_suspend(&isp->isp_hist);
984 isp_suspend_module_pipeline(&isp->isp_res.subdev.entity);
985 isp_suspend_module_pipeline(&isp->isp_prev.subdev.entity);
986 isp_suspend_module_pipeline(&isp->isp_ccdc.subdev.entity);
987 isp_suspend_module_pipeline(&isp->isp_csi2a.subdev.entity);
988 isp_suspend_module_pipeline(&isp->isp_ccp2.subdev.entity);
991 while (omap3isp_stat_busy(&isp->isp_af)
992 || omap3isp_stat_busy(&isp->isp_aewb)
993 || omap3isp_stat_busy(&isp->isp_hist)
994 || omap3isp_preview_busy(&isp->isp_prev)
995 || omap3isp_resizer_busy(&isp->isp_res)
996 || omap3isp_ccdc_busy(&isp->isp_ccdc)) {
998 dev_info(isp->dev, "can't stop modules.\n");
1009 * @isp: OMAP3 ISP device
1011 static void __maybe_unused isp_resume_modules(struct isp_device *isp)
1013 omap3isp_stat_resume(&isp->isp_aewb);
1014 omap3isp_stat_resume(&isp->isp_af);
1015 omap3isp_stat_resume(&isp->isp_hist);
1016 isp_resume_module_pipeline(&isp->isp_res.subdev.entity);
1017 isp_resume_module_pipeline(&isp->isp_prev.subdev.entity);
1018 isp_resume_module_pipeline(&isp->isp_ccdc.subdev.entity);
1019 isp_resume_module_pipeline(&isp->isp_csi2a.subdev.entity);
1020 isp_resume_module_pipeline(&isp->isp_ccp2.subdev.entity);
1025 * @isp: OMAP3 ISP device
1027 static int isp_reset(struct isp_device *isp)
1031 isp_reg_writel(isp,
1032 isp_reg_readl(isp, OMAP3_ISP_IOMEM_MAIN, ISP_SYSCONFIG)
1035 while (!(isp_reg_readl(isp, OMAP3_ISP_IOMEM_MAIN,
1038 dev_alert(isp->dev, "cannot reset ISP\n");
1044 isp->stop_failure = false;
1045 media_entity_enum_zero(&isp->crashed);
1051 * @isp: OMAP3 ISP device
1056 isp_save_context(struct isp_device *isp, struct isp_reg *reg_list)
1061 next->val = isp_reg_readl(isp, next->mmio_range, next->reg);
1066 * @isp: OMAP3 ISP device
1071 isp_restore_context(struct isp_device *isp, struct isp_reg *reg_list)
1076 isp_reg_writel(isp, next->val, next->mmio_range, next->reg);
1081 * @isp: OMAP3 ISP device
1086 static void isp_save_ctx(struct isp_device *isp)
1088 isp_save_context(isp, isp_reg_list);
1089 omap_iommu_save_ctx(isp->dev);
1094 * @isp: OMAP3 ISP device
1099 static void isp_restore_ctx(struct isp_device *isp)
1101 isp_restore_context(isp, isp_reg_list);
1102 omap_iommu_restore_ctx(isp->dev);
1103 omap3isp_ccdc_restore_context(isp);
1104 omap3isp_preview_restore_context(isp);
1120 void omap3isp_sbl_enable(struct isp_device *isp, enum isp_sbl_resource res)
1124 isp->sbl_resources |= res;
1126 if (isp->sbl_resources & OMAP3_ISP_SBL_CSI1_READ)
1129 if (isp->sbl_resources & OMAP3_ISP_SBL_CCDC_LSC_READ)
1132 if (isp->sbl_resources & OMAP3_ISP_SBL_CSI2C_WRITE)
1135 if (isp->sbl_resources & OMAP3_ISP_SBL_RESIZER_WRITE)
1138 if (isp->sbl_resources & OMAP3_ISP_SBL_WRITE)
1141 if (isp->sbl_resources & OMAP3_ISP_SBL_READ)
1144 isp_reg_set(isp, OMAP3_ISP_IOMEM_MAIN, ISP_CTRL, sbl);
1147 void omap3isp_sbl_disable(struct isp_device *isp, enum isp_sbl_resource res)
1151 isp->sbl_resources &= ~res;
1153 if (!(isp->sbl_resources & OMAP3_ISP_SBL_CSI1_READ))
1156 if (!(isp->sbl_resources & OMAP3_ISP_SBL_CCDC_LSC_READ))
1159 if (!(isp->sbl_resources & OMAP3_ISP_SBL_CSI2C_WRITE))
1162 if (!(isp->sbl_resources & OMAP3_ISP_SBL_RESIZER_WRITE))
1165 if (!(isp->sbl_resources & OMAP3_ISP_SBL_WRITE))
1168 if (!(isp->sbl_resources & OMAP3_ISP_SBL_READ))
1171 isp_reg_clr(isp, OMAP3_ISP_IOMEM_MAIN, ISP_CTRL, sbl);
1261 static void __isp_subclk_update(struct isp_device *isp)
1266 if (isp->subclk_resources &
1270 if (isp->subclk_resources & OMAP3_ISP_SUBCLK_HIST)
1273 if (isp->subclk_resources & OMAP3_ISP_SUBCLK_RESIZER)
1279 if (isp->subclk_resources & OMAP3_ISP_SUBCLK_CCDC)
1282 if (isp->subclk_resources & OMAP3_ISP_SUBCLK_PREVIEW)
1285 isp_reg_clr_set(isp, OMAP3_ISP_IOMEM_MAIN, ISP_CTRL,
1289 void omap3isp_subclk_enable(struct isp_device *isp,
1292 isp->subclk_resources |= res;
1294 __isp_subclk_update(isp);
1297 void omap3isp_subclk_disable(struct isp_device *isp,
1300 isp->subclk_resources &= ~res;
1302 __isp_subclk_update(isp);
1307 * @isp: OMAP3 ISP device
1312 static int isp_enable_clocks(struct isp_device *isp)
1317 r = clk_prepare_enable(isp->clock[ISP_CLK_CAM_ICK]);
1319 dev_err(isp->dev, "failed to enable cam_ick clock\n");
1322 r = clk_set_rate(isp->clock[ISP_CLK_CAM_MCLK], CM_CAM_MCLK_HZ);
1324 dev_err(isp->dev, "clk_set_rate for cam_mclk failed\n");
1327 r = clk_prepare_enable(isp->clock[ISP_CLK_CAM_MCLK]);
1329 dev_err(isp->dev, "failed to enable cam_mclk clock\n");
1332 rate = clk_get_rate(isp->clock[ISP_CLK_CAM_MCLK]);
1334 dev_warn(isp->dev, "unexpected cam_mclk rate:\n"
1337 r = clk_prepare_enable(isp->clock[ISP_CLK_CSI2_FCK]);
1339 dev_err(isp->dev, "failed to enable csi2_fck clock\n");
1345 clk_disable_unprepare(isp->clock[ISP_CLK_CAM_MCLK]);
1347 clk_disable_unprepare(isp->clock[ISP_CLK_CAM_ICK]);
1354 * @isp: OMAP3 ISP device
1356 static void isp_disable_clocks(struct isp_device *isp)
1358 clk_disable_unprepare(isp->clock[ISP_CLK_CAM_ICK]);
1359 clk_disable_unprepare(isp->clock[ISP_CLK_CAM_MCLK]);
1360 clk_disable_unprepare(isp->clock[ISP_CLK_CSI2_FCK]);
1370 static int isp_get_clocks(struct isp_device *isp)
1376 clk = devm_clk_get(isp->dev, isp_clocks[i]);
1378 dev_err(isp->dev, "clk_get %s failed\n", isp_clocks[i]);
1382 isp->clock[i] = clk;
1398 static struct isp_device *__omap3isp_get(struct isp_device *isp, bool irq)
1400 struct isp_device *__isp = isp;
1402 if (isp == NULL)
1405 mutex_lock(&isp->isp_mutex);
1406 if (isp->ref_count > 0)
1409 if (isp_enable_clocks(isp) < 0) {
1415 if (isp->has_context)
1416 isp_restore_ctx(isp);
1419 isp_enable_interrupts(isp);
1423 isp->ref_count++;
1424 mutex_unlock(&isp->isp_mutex);
1429 struct isp_device *omap3isp_get(struct isp_device *isp)
1431 return __omap3isp_get(isp, true);
1440 static void __omap3isp_put(struct isp_device *isp, bool save_ctx)
1442 if (isp == NULL)
1445 mutex_lock(&isp->isp_mutex);
1446 BUG_ON(isp->ref_count == 0);
1447 if (--isp->ref_count == 0) {
1448 isp_disable_interrupts(isp);
1450 isp_save_ctx(isp);
1451 isp->has_context = 1;
1456 if (!media_entity_enum_empty(&isp->crashed) ||
1457 isp->stop_failure)
1458 isp_reset(isp);
1459 isp_disable_clocks(isp);
1461 mutex_unlock(&isp->isp_mutex);
1464 void omap3isp_put(struct isp_device *isp)
1466 __omap3isp_put(isp, true);
1475 * @isp: OMAP3 ISP device
1477 #define ISP_PRINT_REGISTER(isp, name)\
1478 dev_dbg(isp->dev, "###ISP " #name "=0x%08x\n", \
1479 isp_reg_readl(isp, OMAP3_ISP_IOMEM_MAIN, ISP_##name))
1480 #define SBL_PRINT_REGISTER(isp, name)\
1481 dev_dbg(isp->dev, "###SBL " #name "=0x%08x\n", \
1482 isp_reg_readl(isp, OMAP3_ISP_IOMEM_SBL, ISPSBL_##name))
1484 void omap3isp_print_status(struct isp_device *isp)
1486 dev_dbg(isp->dev, "-------------ISP Register dump--------------\n");
1488 ISP_PRINT_REGISTER(isp, SYSCONFIG);
1489 ISP_PRINT_REGISTER(isp, SYSSTATUS);
1490 ISP_PRINT_REGISTER(isp, IRQ0ENABLE);
1491 ISP_PRINT_REGISTER(isp, IRQ0STATUS);
1492 ISP_PRINT_REGISTER(isp, TCTRL_GRESET_LENGTH);
1493 ISP_PRINT_REGISTER(isp, TCTRL_PSTRB_REPLAY);
1494 ISP_PRINT_REGISTER(isp, CTRL);
1495 ISP_PRINT_REGISTER(isp, TCTRL_CTRL);
1496 ISP_PRINT_REGISTER(isp, TCTRL_FRAME);
1497 ISP_PRINT_REGISTER(isp, TCTRL_PSTRB_DELAY);
1498 ISP_PRINT_REGISTER(isp, TCTRL_STRB_DELAY);
1499 ISP_PRINT_REGISTER(isp, TCTRL_SHUT_DELAY);
1500 ISP_PRINT_REGISTER(isp, TCTRL_PSTRB_LENGTH);
1501 ISP_PRINT_REGISTER(isp, TCTRL_STRB_LENGTH);
1502 ISP_PRINT_REGISTER(isp, TCTRL_SHUT_LENGTH);
1504 SBL_PRINT_REGISTER(isp, PCR);
1505 SBL_PRINT_REGISTER(isp, SDR_REQ_EXP);
1507 dev_dbg(isp->dev, "--------------------------------------------\n");
1531 struct isp_device *isp = dev_get_drvdata(dev);
1534 WARN_ON(mutex_is_locked(&isp->isp_mutex));
1536 if (isp->ref_count == 0)
1539 reset = isp_suspend_modules(isp);
1540 isp_disable_interrupts(isp);
1541 isp_save_ctx(isp);
1543 isp_reset(isp);
1550 struct isp_device *isp = dev_get_drvdata(dev);
1552 WARN_ON(mutex_is_locked(&isp->isp_mutex));
1554 if (isp->ref_count)
1555 isp_disable_clocks(isp);
1562 struct isp_device *isp = dev_get_drvdata(dev);
1564 if (isp->ref_count == 0)
1567 return isp_enable_clocks(isp);
1572 struct isp_device *isp = dev_get_drvdata(dev);
1574 if (isp->ref_count == 0)
1577 isp_restore_ctx(isp);
1578 isp_enable_interrupts(isp);
1579 isp_resume_modules(isp);
1591 static void isp_unregister_entities(struct isp_device *isp)
1593 media_device_unregister(&isp->media_dev);
1595 omap3isp_csi2_unregister_entities(&isp->isp_csi2a);
1596 omap3isp_ccp2_unregister_entities(&isp->isp_ccp2);
1597 omap3isp_ccdc_unregister_entities(&isp->isp_ccdc);
1598 omap3isp_preview_unregister_entities(&isp->isp_prev);
1599 omap3isp_resizer_unregister_entities(&isp->isp_res);
1600 omap3isp_stat_unregister_entities(&isp->isp_aewb);
1601 omap3isp_stat_unregister_entities(&isp->isp_af);
1602 omap3isp_stat_unregister_entities(&isp->isp_hist);
1604 v4l2_device_unregister(&isp->v4l2_dev);
1605 media_device_cleanup(&isp->media_dev);
1609 struct isp_device *isp, struct media_entity *entity,
1624 input = &isp->isp_ccdc.subdev.entity;
1630 input = &isp->isp_csi2a.subdev.entity;
1637 input = &isp->isp_ccp2.subdev.entity;
1643 input = &isp->isp_csi2c.subdev.entity;
1649 dev_err(isp->dev, "%s: invalid interface type %u\n", __func__,
1661 dev_err(isp->dev, "%s: invalid input %u\n", entity->name,
1671 dev_err(isp->dev, "%s: no source pad in external entity %s\n",
1679 static int isp_register_entities(struct isp_device *isp)
1683 isp->media_dev.dev = isp->dev;
1684 strscpy(isp->media_dev.model, "TI OMAP3 ISP",
1685 sizeof(isp->media_dev.model));
1686 isp->media_dev.hw_revision = isp->revision;
1687 isp->media_dev.ops = &isp_media_ops;
1688 media_device_init(&isp->media_dev);
1690 isp->v4l2_dev.mdev = &isp->media_dev;
1691 ret = v4l2_device_register(isp->dev, &isp->v4l2_dev);
1693 dev_err(isp->dev, "%s: V4L2 device registration failed (%d)\n",
1699 ret = omap3isp_ccp2_register_entities(&isp->isp_ccp2, &isp->v4l2_dev);
1703 ret = omap3isp_csi2_register_entities(&isp->isp_csi2a, &isp->v4l2_dev);
1707 ret = omap3isp_ccdc_register_entities(&isp->isp_ccdc, &isp->v4l2_dev);
1711 ret = omap3isp_preview_register_entities(&isp->isp_prev,
1712 &isp->v4l2_dev);
1716 ret = omap3isp_resizer_register_entities(&isp->isp_res, &isp->v4l2_dev);
1720 ret = omap3isp_stat_register_entities(&isp->isp_aewb, &isp->v4l2_dev);
1724 ret = omap3isp_stat_register_entities(&isp->isp_af, &isp->v4l2_dev);
1728 ret = omap3isp_stat_register_entities(&isp->isp_hist, &isp->v4l2_dev);
1734 isp_unregister_entities(isp);
1741 * @isp : Pointer to ISP device
1748 static int isp_create_links(struct isp_device *isp)
1754 &isp->isp_csi2a.subdev.entity, CSI2_PAD_SOURCE,
1755 &isp->isp_csi2a.video_out.video.entity, 0, 0);
1760 &isp->isp_ccp2.video_in.video.entity, 0,
1761 &isp->isp_ccp2.subdev.entity, CCP2_PAD_SINK, 0);
1766 &isp->isp_ccdc.subdev.entity, CCDC_PAD_SOURCE_OF,
1767 &isp->isp_ccdc.video_out.video.entity, 0, 0);
1772 &isp->isp_prev.video_in.video.entity, 0,
1773 &isp->isp_prev.subdev.entity, PREV_PAD_SINK, 0);
1778 &isp->isp_prev.subdev.entity, PREV_PAD_SOURCE,
1779 &isp->isp_prev.video_out.video.entity, 0, 0);
1784 &isp->isp_res.video_in.video.entity, 0,
1785 &isp->isp_res.subdev.entity, RESZ_PAD_SINK, 0);
1790 &isp->isp_res.subdev.entity, RESZ_PAD_SOURCE,
1791 &isp->isp_res.video_out.video.entity, 0, 0);
1798 &isp->isp_csi2a.subdev.entity, CSI2_PAD_SOURCE,
1799 &isp->isp_ccdc.subdev.entity, CCDC_PAD_SINK, 0);
1804 &isp->isp_ccp2.subdev.entity, CCP2_PAD_SOURCE,
1805 &isp->isp_ccdc.subdev.entity, CCDC_PAD_SINK, 0);
1810 &isp->isp_ccdc.subdev.entity, CCDC_PAD_SOURCE_VP,
1811 &isp->isp_prev.subdev.entity, PREV_PAD_SINK, 0);
1816 &isp->isp_ccdc.subdev.entity, CCDC_PAD_SOURCE_OF,
1817 &isp->isp_res.subdev.entity, RESZ_PAD_SINK, 0);
1822 &isp->isp_prev.subdev.entity, PREV_PAD_SOURCE,
1823 &isp->isp_res.subdev.entity, RESZ_PAD_SINK, 0);
1828 &isp->isp_ccdc.subdev.entity, CCDC_PAD_SOURCE_VP,
1829 &isp->isp_aewb.subdev.entity, 0,
1835 &isp->isp_ccdc.subdev.entity, CCDC_PAD_SOURCE_VP,
1836 &isp->isp_af.subdev.entity, 0,
1842 &isp->isp_ccdc.subdev.entity, CCDC_PAD_SOURCE_VP,
1843 &isp->isp_hist.subdev.entity, 0,
1851 static void isp_cleanup_modules(struct isp_device *isp)
1853 omap3isp_h3a_aewb_cleanup(isp);
1854 omap3isp_h3a_af_cleanup(isp);
1855 omap3isp_hist_cleanup(isp);
1856 omap3isp_resizer_cleanup(isp);
1857 omap3isp_preview_cleanup(isp);
1858 omap3isp_ccdc_cleanup(isp);
1859 omap3isp_ccp2_cleanup(isp);
1860 omap3isp_csi2_cleanup(isp);
1861 omap3isp_csiphy_cleanup(isp);
1864 static int isp_initialize_modules(struct isp_device *isp)
1868 ret = omap3isp_csiphy_init(isp);
1870 dev_err(isp->dev, "CSI PHY initialization failed\n");
1874 ret = omap3isp_csi2_init(isp);
1876 dev_err(isp->dev, "CSI2 initialization failed\n");
1880 ret = omap3isp_ccp2_init(isp);
1883 dev_err(isp->dev, "CCP2 initialization failed\n");
1887 ret = omap3isp_ccdc_init(isp);
1889 dev_err(isp->dev, "CCDC initialization failed\n");
1893 ret = omap3isp_preview_init(isp);
1895 dev_err(isp->dev, "Preview initialization failed\n");
1899 ret = omap3isp_resizer_init(isp);
1901 dev_err(isp->dev, "Resizer initialization failed\n");
1905 ret = omap3isp_hist_init(isp);
1907 dev_err(isp->dev, "Histogram initialization failed\n");
1911 ret = omap3isp_h3a_aewb_init(isp);
1913 dev_err(isp->dev, "H3A AEWB initialization failed\n");
1917 ret = omap3isp_h3a_af_init(isp);
1919 dev_err(isp->dev, "H3A AF initialization failed\n");
1926 omap3isp_h3a_aewb_cleanup(isp);
1928 omap3isp_hist_cleanup(isp);
1930 omap3isp_resizer_cleanup(isp);
1932 omap3isp_preview_cleanup(isp);
1934 omap3isp_ccdc_cleanup(isp);
1936 omap3isp_ccp2_cleanup(isp);
1938 omap3isp_csi2_cleanup(isp);
1940 omap3isp_csiphy_cleanup(isp);
1945 static void isp_detach_iommu(struct isp_device *isp)
1948 arm_iommu_detach_device(isp->dev);
1949 arm_iommu_release_mapping(isp->mapping);
1950 isp->mapping = NULL;
1954 static int isp_attach_iommu(struct isp_device *isp)
1966 dev_err(isp->dev, "failed to create ARM IOMMU mapping\n");
1970 isp->mapping = mapping;
1973 ret = arm_iommu_attach_device(isp->dev, mapping);
1975 dev_err(isp->dev, "failed to attach device to VA mapping\n");
1982 arm_iommu_release_mapping(isp->mapping);
1983 isp->mapping = NULL;
1998 struct isp_device *isp = platform_get_drvdata(pdev);
2000 v4l2_async_notifier_unregister(&isp->notifier);
2001 isp_unregister_entities(isp);
2002 isp_cleanup_modules(isp);
2003 isp_xclk_cleanup(isp);
2005 __omap3isp_get(isp, false);
2006 isp_detach_iommu(isp);
2007 __omap3isp_put(isp, false);
2009 media_entity_enum_cleanup(&isp->crashed);
2010 v4l2_async_notifier_cleanup(&isp->notifier);
2012 kfree(isp);
2025 struct isp_device *isp = container_of(async, struct isp_device,
2027 struct v4l2_device *v4l2_dev = &isp->v4l2_dev;
2031 ret = media_entity_enum_init(&isp->crashed, &isp->media_dev);
2036 if (sd->notifier != &isp->notifier)
2039 ret = isp_link_entity(isp, &sd->entity,
2045 ret = v4l2_device_register_subdev_nodes(&isp->v4l2_dev);
2049 return media_device_register(&isp->media_dev);
2140 static int isp_parse_of_endpoints(struct isp_device *isp)
2148 dev_fwnode(isp->dev), ISP_OF_PHY_PARALLEL, 0,
2157 dev_dbg(isp->dev, "parsing parallel interface\n");
2163 &isp->notifier, ep, sizeof(*isd));
2166 isp_parse_of_parallel_endpoint(isp->dev, &vep, &isd->bus);
2180 dev_fwnode(isp->dev), isp_bus_interfaces[i].phy, 0,
2186 dev_dbg(isp->dev, "parsing serial interface %u, node %pOF\n", i,
2204 &isp->notifier, ep, sizeof(*isd));
2213 isp_parse_of_csi2_endpoint(isp->dev, &vep, &isd->bus);
2219 isp_parse_of_csi1_endpoint(isp->dev, &vep,
2251 struct isp_device *isp;
2256 isp = kzalloc(sizeof(*isp), GFP_KERNEL);
2257 if (!isp) {
2263 "ti,phy-type", &isp->phy_type);
2267 isp->syscon = syscon_regmap_lookup_by_phandle(pdev->dev.of_node,
2269 if (IS_ERR(isp->syscon)) {
2270 ret = PTR_ERR(isp->syscon);
2275 "syscon", 1, &isp->syscon_offset);
2279 isp->autoidle = autoidle;
2281 mutex_init(&isp->isp_mutex);
2282 spin_lock_init(&isp->stat_lock);
2283 v4l2_async_notifier_init(&isp->notifier);
2284 isp->dev = &pdev->dev;
2286 ret = isp_parse_of_endpoints(isp);
2290 isp->ref_count = 0;
2292 ret = dma_coerce_mask_and_coherent(isp->dev, DMA_BIT_MASK(32));
2296 platform_set_drvdata(pdev, isp);
2299 isp->isp_csiphy1.vdd = devm_regulator_get(&pdev->dev, "vdd-csiphy1");
2300 if (IS_ERR(isp->isp_csiphy1.vdd)) {
2301 ret = PTR_ERR(isp->isp_csiphy1.vdd);
2305 isp->isp_csiphy2.vdd = devm_regulator_get(&pdev->dev, "vdd-csiphy2");
2306 if (IS_ERR(isp->isp_csiphy2.vdd)) {
2307 ret = PTR_ERR(isp->isp_csiphy2.vdd);
2325 isp->mmio_base[map_idx] =
2326 devm_ioremap_resource(isp->dev, mem);
2327 if (IS_ERR(isp->mmio_base[map_idx])) {
2328 ret = PTR_ERR(isp->mmio_base[map_idx]);
2333 ret = isp_get_clocks(isp);
2337 ret = clk_enable(isp->clock[ISP_CLK_CAM_ICK]);
2341 isp->revision = isp_reg_readl(isp, OMAP3_ISP_IOMEM_MAIN, ISP_REVISION);
2342 dev_info(isp->dev, "Revision %d.%d found\n",
2343 (isp->revision & 0xf0) >> 4, isp->revision & 0x0f);
2345 clk_disable(isp->clock[ISP_CLK_CAM_ICK]);
2347 if (__omap3isp_get(isp, false) == NULL) {
2352 ret = isp_reset(isp);
2356 ret = isp_xclk_init(isp);
2362 if (isp->revision == isp_res_maps[m].isp_rev)
2366 dev_err(isp->dev, "No resource map found for ISP rev %d.%d\n",
2367 (isp->revision & 0xf0) >> 4, isp->revision & 0xf);
2373 isp->mmio_base[i] =
2374 isp->mmio_base[0] + isp_res_maps[m].offset[i];
2377 isp->mmio_base[i] =
2378 isp->mmio_base[OMAP3_ISP_IOMEM_CSI2A_REGS1]
2381 isp->mmio_hist_base_phys =
2385 ret = isp_attach_iommu(isp);
2397 isp->irq_num = ret;
2399 if (devm_request_irq(isp->dev, isp->irq_num, isp_isr, IRQF_SHARED,
2400 "OMAP3 ISP", isp)) {
2401 dev_err(isp->dev, "Unable to request IRQ\n");
2407 ret = isp_initialize_modules(isp);
2411 ret = isp_register_entities(isp);
2415 ret = isp_create_links(isp);
2419 isp->notifier.ops = &isp_subdev_notifier_ops;
2421 ret = v4l2_async_notifier_register(&isp->v4l2_dev, &isp->notifier);
2425 isp_core_init(isp, 1);
2426 omap3isp_put(isp);
2431 isp_unregister_entities(isp);
2433 isp_cleanup_modules(isp);
2435 isp_detach_iommu(isp);
2437 isp_xclk_cleanup(isp);
2438 __omap3isp_put(isp, false);
2440 v4l2_async_notifier_cleanup(&isp->notifier);
2441 mutex_destroy(&isp->isp_mutex);
2443 kfree(isp);
2462 { .compatible = "ti,omap3-isp" },