Lines Matching +full:csi +full:- +full:2
1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * Copyright (C) 2012-2014 Mentor Graphics Inc.
4 * Copyright (C) 2005-2009 Freescale Semiconductor, Inc.
15 #include <uapi/linux/v4l2-mediabus.h>
17 #include <linux/clk-provider.h>
20 #include "ipu-prv.h"
32 /* CSI Register Offsets */
55 /* CSI Register Fields */
60 #define CSI_SENS_CONF_DATA_FMT_YUV422_UYVY 2L
69 #define CSI_SENS_CONF_DATA_POL_SHIFT 2
86 #define CSI_DATA_DEST_IC 2
116 /* MIPI CSI-2 data types */
133 * Bitfield of CSI bus signal polarities and modes.
153 * Enumeration of CSI data bus widths.
164 * Enumeration of CSI clock modes.
177 static inline u32 ipu_csi_read(struct ipu_csi *csi, unsigned offset) in ipu_csi_read() argument
179 return readl(csi->base + offset); in ipu_csi_read()
182 static inline void ipu_csi_write(struct ipu_csi *csi, u32 value, in ipu_csi_write() argument
185 writel(value, csi->base + offset); in ipu_csi_write()
192 static int ipu_csi_set_testgen_mclk(struct ipu_csi *csi, u32 pixel_clk, in ipu_csi_set_testgen_mclk() argument
198 div_ratio = (ipu_clk / pixel_clk) - 1; in ipu_csi_set_testgen_mclk()
201 dev_err(csi->ipu->dev, in ipu_csi_set_testgen_mclk()
203 return -EINVAL; in ipu_csi_set_testgen_mclk()
206 temp = ipu_csi_read(csi, CSI_SENS_CONF); in ipu_csi_set_testgen_mclk()
208 ipu_csi_write(csi, temp | (div_ratio << CSI_SENS_CONF_DIVRATIO_SHIFT), in ipu_csi_set_testgen_mclk()
215 * Find the CSI data format and data width for the given V4L2 media
227 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_RGB565; in mbus_code_to_bus_cfg()
229 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; in mbus_code_to_bus_cfg()
230 cfg->mipi_dt = MIPI_DT_RGB565; in mbus_code_to_bus_cfg()
231 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
235 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_RGB444; in mbus_code_to_bus_cfg()
236 cfg->mipi_dt = MIPI_DT_RGB444; in mbus_code_to_bus_cfg()
237 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
241 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_RGB555; in mbus_code_to_bus_cfg()
242 cfg->mipi_dt = MIPI_DT_RGB555; in mbus_code_to_bus_cfg()
243 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
247 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_RGB_YUV444; in mbus_code_to_bus_cfg()
248 cfg->mipi_dt = MIPI_DT_RGB888; in mbus_code_to_bus_cfg()
249 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
252 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_YUV422_UYVY; in mbus_code_to_bus_cfg()
253 cfg->mipi_dt = MIPI_DT_YUV422; in mbus_code_to_bus_cfg()
254 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
257 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_YUV422_YUYV; in mbus_code_to_bus_cfg()
258 cfg->mipi_dt = MIPI_DT_YUV422; in mbus_code_to_bus_cfg()
259 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
263 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; in mbus_code_to_bus_cfg()
264 cfg->mipi_dt = MIPI_DT_YUV422; in mbus_code_to_bus_cfg()
265 cfg->data_width = IPU_CSI_DATA_WIDTH_16; in mbus_code_to_bus_cfg()
272 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; in mbus_code_to_bus_cfg()
273 cfg->mipi_dt = MIPI_DT_RAW8; in mbus_code_to_bus_cfg()
274 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
284 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; in mbus_code_to_bus_cfg()
285 cfg->mipi_dt = MIPI_DT_RAW10; in mbus_code_to_bus_cfg()
286 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
293 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; in mbus_code_to_bus_cfg()
294 cfg->mipi_dt = MIPI_DT_RAW10; in mbus_code_to_bus_cfg()
295 cfg->data_width = IPU_CSI_DATA_WIDTH_10; in mbus_code_to_bus_cfg()
302 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; in mbus_code_to_bus_cfg()
303 cfg->mipi_dt = MIPI_DT_RAW12; in mbus_code_to_bus_cfg()
304 cfg->data_width = IPU_CSI_DATA_WIDTH_12; in mbus_code_to_bus_cfg()
308 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_JPEG; in mbus_code_to_bus_cfg()
309 cfg->mipi_dt = MIPI_DT_RAW8; in mbus_code_to_bus_cfg()
310 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
313 return -EINVAL; in mbus_code_to_bus_cfg()
329 * Fill a CSI bus config struct from mbus_config and mbus_framefmt.
339 ret = mbus_code_to_bus_cfg(csicfg, mbus_fmt->code, mbus_cfg->type); in fill_csi_bus_cfg()
343 switch (mbus_cfg->type) { in fill_csi_bus_cfg()
345 csicfg->ext_vsync = 1; in fill_csi_bus_cfg()
346 csicfg->vsync_pol = (mbus_cfg->flags & in fill_csi_bus_cfg()
348 csicfg->hsync_pol = (mbus_cfg->flags & in fill_csi_bus_cfg()
350 csicfg->pixclk_pol = (mbus_cfg->flags & in fill_csi_bus_cfg()
352 csicfg->clk_mode = IPU_CSI_CLK_MODE_GATED_CLK; in fill_csi_bus_cfg()
355 csicfg->ext_vsync = 0; in fill_csi_bus_cfg()
356 if (V4L2_FIELD_HAS_BOTH(mbus_fmt->field) || in fill_csi_bus_cfg()
357 mbus_fmt->field == V4L2_FIELD_ALTERNATE) in fill_csi_bus_cfg()
358 csicfg->clk_mode = IPU_CSI_CLK_MODE_CCIR656_INTERLACED; in fill_csi_bus_cfg()
360 csicfg->clk_mode = IPU_CSI_CLK_MODE_CCIR656_PROGRESSIVE; in fill_csi_bus_cfg()
364 * MIPI CSI-2 requires non gated clock mode, all other in fill_csi_bus_cfg()
365 * parameters are not applicable for MIPI CSI-2 bus. in fill_csi_bus_cfg()
367 csicfg->clk_mode = IPU_CSI_CLK_MODE_NONGATED_CLK; in fill_csi_bus_cfg()
378 ipu_csi_set_bt_interlaced_codes(struct ipu_csi *csi, in ipu_csi_set_bt_interlaced_codes() argument
387 infield = ipu_csi_translate_field(infmt->field, std); in ipu_csi_set_bt_interlaced_codes()
388 outfield = ipu_csi_translate_field(outfmt->field, std); in ipu_csi_set_bt_interlaced_codes()
391 * Write the H-V-F codes the CSI will match against the in ipu_csi_set_bt_interlaced_codes()
395 * is SEQ_TB), swap the F-bit so that the CSI will capture in ipu_csi_set_bt_interlaced_codes()
409 ipu_csi_write(csi, 0x40596 | CSI_CCIR_ERR_DET_EN, in ipu_csi_set_bt_interlaced_codes()
411 ipu_csi_write(csi, 0xD07DF, CSI_CCIR_CODE_2); in ipu_csi_set_bt_interlaced_codes()
413 dev_dbg(csi->ipu->dev, "capture field swap\n"); in ipu_csi_set_bt_interlaced_codes()
415 /* same as above but with F-bit inverted */ in ipu_csi_set_bt_interlaced_codes()
416 ipu_csi_write(csi, 0xD07DF | CSI_CCIR_ERR_DET_EN, in ipu_csi_set_bt_interlaced_codes()
418 ipu_csi_write(csi, 0x40596, CSI_CCIR_CODE_2); in ipu_csi_set_bt_interlaced_codes()
421 ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3); in ipu_csi_set_bt_interlaced_codes()
427 int ipu_csi_init_interface(struct ipu_csi *csi, in ipu_csi_init_interface() argument
443 width = infmt->width; in ipu_csi_init_interface()
444 height = infmt->height; in ipu_csi_init_interface()
445 if (infmt->field == V4L2_FIELD_ALTERNATE) in ipu_csi_init_interface()
446 height *= 2; in ipu_csi_init_interface()
461 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_init_interface()
463 ipu_csi_write(csi, data, CSI_SENS_CONF); in ipu_csi_init_interface()
469 ipu_csi_write(csi, 0x40030, CSI_CCIR_CODE_1); in ipu_csi_init_interface()
470 ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3); in ipu_csi_init_interface()
480 dev_err(csi->ipu->dev, in ipu_csi_init_interface()
482 ret = -EINVAL; in ipu_csi_init_interface()
486 ret = ipu_csi_set_bt_interlaced_codes(csi, infmt, outfmt, std); in ipu_csi_init_interface()
494 ipu_csi_write(csi, 0x40030 | CSI_CCIR_ERR_DET_EN, in ipu_csi_init_interface()
496 ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3); in ipu_csi_init_interface()
500 ipu_csi_write(csi, 0, CSI_CCIR_CODE_1); in ipu_csi_init_interface()
505 ipu_csi_write(csi, (width - 1) | ((height - 1) << 16), in ipu_csi_init_interface()
508 dev_dbg(csi->ipu->dev, "CSI_SENS_CONF = 0x%08X\n", in ipu_csi_init_interface()
509 ipu_csi_read(csi, CSI_SENS_CONF)); in ipu_csi_init_interface()
510 dev_dbg(csi->ipu->dev, "CSI_ACT_FRM_SIZE = 0x%08X\n", in ipu_csi_init_interface()
511 ipu_csi_read(csi, CSI_ACT_FRM_SIZE)); in ipu_csi_init_interface()
514 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_init_interface()
520 bool ipu_csi_is_interlaced(struct ipu_csi *csi) in ipu_csi_is_interlaced() argument
525 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_is_interlaced()
527 (ipu_csi_read(csi, CSI_SENS_CONF) & in ipu_csi_is_interlaced()
530 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_is_interlaced()
544 dev_err(csi->ipu->dev, in ipu_csi_is_interlaced()
545 "CSI %d sensor protocol unsupported\n", csi->id); in ipu_csi_is_interlaced()
551 void ipu_csi_get_window(struct ipu_csi *csi, struct v4l2_rect *w) in ipu_csi_get_window() argument
556 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_get_window()
558 reg = ipu_csi_read(csi, CSI_ACT_FRM_SIZE); in ipu_csi_get_window()
559 w->width = (reg & 0xFFFF) + 1; in ipu_csi_get_window()
560 w->height = (reg >> 16 & 0xFFFF) + 1; in ipu_csi_get_window()
562 reg = ipu_csi_read(csi, CSI_OUT_FRM_CTRL); in ipu_csi_get_window()
563 w->left = (reg & CSI_HSC_MASK) >> CSI_HSC_SHIFT; in ipu_csi_get_window()
564 w->top = (reg & CSI_VSC_MASK) >> CSI_VSC_SHIFT; in ipu_csi_get_window()
566 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_get_window()
570 void ipu_csi_set_window(struct ipu_csi *csi, struct v4l2_rect *w) in ipu_csi_set_window() argument
575 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_set_window()
577 ipu_csi_write(csi, (w->width - 1) | ((w->height - 1) << 16), in ipu_csi_set_window()
580 reg = ipu_csi_read(csi, CSI_OUT_FRM_CTRL); in ipu_csi_set_window()
582 reg |= ((w->top << CSI_VSC_SHIFT) | (w->left << CSI_HSC_SHIFT)); in ipu_csi_set_window()
583 ipu_csi_write(csi, reg, CSI_OUT_FRM_CTRL); in ipu_csi_set_window()
585 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_set_window()
589 void ipu_csi_set_downsize(struct ipu_csi *csi, bool horiz, bool vert) in ipu_csi_set_downsize() argument
594 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_set_downsize()
596 reg = ipu_csi_read(csi, CSI_OUT_FRM_CTRL); in ipu_csi_set_downsize()
600 ipu_csi_write(csi, reg, CSI_OUT_FRM_CTRL); in ipu_csi_set_downsize()
602 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_set_downsize()
606 void ipu_csi_set_test_generator(struct ipu_csi *csi, bool active, in ipu_csi_set_test_generator() argument
611 u32 ipu_clk = clk_get_rate(csi->clk_ipu); in ipu_csi_set_test_generator()
614 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_set_test_generator()
616 temp = ipu_csi_read(csi, CSI_TST_CTRL); in ipu_csi_set_test_generator()
620 ipu_csi_write(csi, temp, CSI_TST_CTRL); in ipu_csi_set_test_generator()
623 ipu_csi_set_testgen_mclk(csi, pix_clk, ipu_clk); in ipu_csi_set_test_generator()
631 ipu_csi_write(csi, temp, CSI_TST_CTRL); in ipu_csi_set_test_generator()
634 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_set_test_generator()
638 int ipu_csi_set_mipi_datatype(struct ipu_csi *csi, u32 vc, in ipu_csi_set_mipi_datatype() argument
647 return -EINVAL; in ipu_csi_set_mipi_datatype()
649 ret = mbus_code_to_bus_cfg(&cfg, mbus_fmt->code, V4L2_MBUS_CSI2_DPHY); in ipu_csi_set_mipi_datatype()
653 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_set_mipi_datatype()
655 temp = ipu_csi_read(csi, CSI_MIPI_DI); in ipu_csi_set_mipi_datatype()
658 ipu_csi_write(csi, temp, CSI_MIPI_DI); in ipu_csi_set_mipi_datatype()
660 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_set_mipi_datatype()
666 int ipu_csi_set_skip_smfc(struct ipu_csi *csi, u32 skip, in ipu_csi_set_skip_smfc() argument
673 return -EINVAL; in ipu_csi_set_skip_smfc()
675 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_set_skip_smfc()
677 temp = ipu_csi_read(csi, CSI_SKIP); in ipu_csi_set_skip_smfc()
683 ipu_csi_write(csi, temp, CSI_SKIP); in ipu_csi_set_skip_smfc()
685 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_set_skip_smfc()
691 int ipu_csi_set_dest(struct ipu_csi *csi, enum ipu_csi_dest csi_dest) in ipu_csi_set_dest() argument
701 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_set_dest()
703 csi_sens_conf = ipu_csi_read(csi, CSI_SENS_CONF); in ipu_csi_set_dest()
706 ipu_csi_write(csi, csi_sens_conf, CSI_SENS_CONF); in ipu_csi_set_dest()
708 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_set_dest()
714 int ipu_csi_enable(struct ipu_csi *csi) in ipu_csi_enable() argument
716 ipu_module_enable(csi->ipu, csi->module); in ipu_csi_enable()
722 int ipu_csi_disable(struct ipu_csi *csi) in ipu_csi_disable() argument
724 ipu_module_disable(csi->ipu, csi->module); in ipu_csi_disable()
733 struct ipu_csi *csi, *ret; in ipu_csi_get() local
736 return ERR_PTR(-EINVAL); in ipu_csi_get()
738 csi = ipu->csi_priv[id]; in ipu_csi_get()
739 ret = csi; in ipu_csi_get()
741 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_get()
743 if (csi->inuse) { in ipu_csi_get()
744 ret = ERR_PTR(-EBUSY); in ipu_csi_get()
748 csi->inuse = true; in ipu_csi_get()
750 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_get()
755 void ipu_csi_put(struct ipu_csi *csi) in ipu_csi_put() argument
759 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_put()
760 csi->inuse = false; in ipu_csi_put()
761 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_put()
768 struct ipu_csi *csi; in ipu_csi_init() local
771 return -ENODEV; in ipu_csi_init()
773 csi = devm_kzalloc(dev, sizeof(*csi), GFP_KERNEL); in ipu_csi_init()
774 if (!csi) in ipu_csi_init()
775 return -ENOMEM; in ipu_csi_init()
777 ipu->csi_priv[id] = csi; in ipu_csi_init()
779 spin_lock_init(&csi->lock); in ipu_csi_init()
780 csi->module = module; in ipu_csi_init()
781 csi->id = id; in ipu_csi_init()
782 csi->clk_ipu = clk_ipu; in ipu_csi_init()
783 csi->base = devm_ioremap(dev, base, PAGE_SIZE); in ipu_csi_init()
784 if (!csi->base) in ipu_csi_init()
785 return -ENOMEM; in ipu_csi_init()
787 dev_dbg(dev, "CSI%d base: 0x%08lx remapped to %p\n", in ipu_csi_init()
788 id, base, csi->base); in ipu_csi_init()
789 csi->ipu = ipu; in ipu_csi_init()
798 void ipu_csi_dump(struct ipu_csi *csi) in ipu_csi_dump() argument
800 dev_dbg(csi->ipu->dev, "CSI_SENS_CONF: %08x\n", in ipu_csi_dump()
801 ipu_csi_read(csi, CSI_SENS_CONF)); in ipu_csi_dump()
802 dev_dbg(csi->ipu->dev, "CSI_SENS_FRM_SIZE: %08x\n", in ipu_csi_dump()
803 ipu_csi_read(csi, CSI_SENS_FRM_SIZE)); in ipu_csi_dump()
804 dev_dbg(csi->ipu->dev, "CSI_ACT_FRM_SIZE: %08x\n", in ipu_csi_dump()
805 ipu_csi_read(csi, CSI_ACT_FRM_SIZE)); in ipu_csi_dump()
806 dev_dbg(csi->ipu->dev, "CSI_OUT_FRM_CTRL: %08x\n", in ipu_csi_dump()
807 ipu_csi_read(csi, CSI_OUT_FRM_CTRL)); in ipu_csi_dump()
808 dev_dbg(csi->ipu->dev, "CSI_TST_CTRL: %08x\n", in ipu_csi_dump()
809 ipu_csi_read(csi, CSI_TST_CTRL)); in ipu_csi_dump()
810 dev_dbg(csi->ipu->dev, "CSI_CCIR_CODE_1: %08x\n", in ipu_csi_dump()
811 ipu_csi_read(csi, CSI_CCIR_CODE_1)); in ipu_csi_dump()
812 dev_dbg(csi->ipu->dev, "CSI_CCIR_CODE_2: %08x\n", in ipu_csi_dump()
813 ipu_csi_read(csi, CSI_CCIR_CODE_2)); in ipu_csi_dump()
814 dev_dbg(csi->ipu->dev, "CSI_CCIR_CODE_3: %08x\n", in ipu_csi_dump()
815 ipu_csi_read(csi, CSI_CCIR_CODE_3)); in ipu_csi_dump()
816 dev_dbg(csi->ipu->dev, "CSI_MIPI_DI: %08x\n", in ipu_csi_dump()
817 ipu_csi_read(csi, CSI_MIPI_DI)); in ipu_csi_dump()
818 dev_dbg(csi->ipu->dev, "CSI_SKIP: %08x\n", in ipu_csi_dump()
819 ipu_csi_read(csi, CSI_SKIP)); in ipu_csi_dump()