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()
189 * Find the CSI data format and data width for the given V4L2 media
201 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_RGB565; in mbus_code_to_bus_cfg()
203 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; in mbus_code_to_bus_cfg()
204 cfg->mipi_dt = MIPI_DT_RGB565; in mbus_code_to_bus_cfg()
205 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
209 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_RGB444; in mbus_code_to_bus_cfg()
210 cfg->mipi_dt = MIPI_DT_RGB444; in mbus_code_to_bus_cfg()
211 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
215 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_RGB555; in mbus_code_to_bus_cfg()
216 cfg->mipi_dt = MIPI_DT_RGB555; in mbus_code_to_bus_cfg()
217 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
221 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_RGB_YUV444; in mbus_code_to_bus_cfg()
222 cfg->mipi_dt = MIPI_DT_RGB888; in mbus_code_to_bus_cfg()
223 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
226 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_YUV422_UYVY; in mbus_code_to_bus_cfg()
227 cfg->mipi_dt = MIPI_DT_YUV422; in mbus_code_to_bus_cfg()
228 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
231 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_YUV422_YUYV; in mbus_code_to_bus_cfg()
232 cfg->mipi_dt = MIPI_DT_YUV422; in mbus_code_to_bus_cfg()
233 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
237 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_YUV422_UYVY; in mbus_code_to_bus_cfg()
238 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
240 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; in mbus_code_to_bus_cfg()
241 cfg->data_width = IPU_CSI_DATA_WIDTH_16; in mbus_code_to_bus_cfg()
243 cfg->mipi_dt = MIPI_DT_YUV422; in mbus_code_to_bus_cfg()
247 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_YUV422_YUYV; in mbus_code_to_bus_cfg()
248 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
250 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; in mbus_code_to_bus_cfg()
251 cfg->data_width = IPU_CSI_DATA_WIDTH_16; in mbus_code_to_bus_cfg()
253 cfg->mipi_dt = MIPI_DT_YUV422; in mbus_code_to_bus_cfg()
260 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; in mbus_code_to_bus_cfg()
261 cfg->mipi_dt = MIPI_DT_RAW8; in mbus_code_to_bus_cfg()
262 cfg->data_width = IPU_CSI_DATA_WIDTH_8; 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_RAW10; in mbus_code_to_bus_cfg()
274 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
281 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; in mbus_code_to_bus_cfg()
282 cfg->mipi_dt = MIPI_DT_RAW10; in mbus_code_to_bus_cfg()
283 cfg->data_width = IPU_CSI_DATA_WIDTH_10; in mbus_code_to_bus_cfg()
290 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; in mbus_code_to_bus_cfg()
291 cfg->mipi_dt = MIPI_DT_RAW12; in mbus_code_to_bus_cfg()
292 cfg->data_width = IPU_CSI_DATA_WIDTH_12; in mbus_code_to_bus_cfg()
296 cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_JPEG; in mbus_code_to_bus_cfg()
297 cfg->mipi_dt = MIPI_DT_RAW8; in mbus_code_to_bus_cfg()
298 cfg->data_width = IPU_CSI_DATA_WIDTH_8; in mbus_code_to_bus_cfg()
301 return -EINVAL; in mbus_code_to_bus_cfg()
317 * Fill a CSI bus config struct from mbus_config and mbus_framefmt.
327 ret = mbus_code_to_bus_cfg(csicfg, mbus_fmt->code, mbus_cfg->type); in fill_csi_bus_cfg()
331 switch (mbus_cfg->type) { in fill_csi_bus_cfg()
333 csicfg->ext_vsync = 1; in fill_csi_bus_cfg()
334 csicfg->vsync_pol = (mbus_cfg->bus.parallel.flags & in fill_csi_bus_cfg()
336 csicfg->hsync_pol = (mbus_cfg->bus.parallel.flags & in fill_csi_bus_cfg()
338 csicfg->pixclk_pol = (mbus_cfg->bus.parallel.flags & in fill_csi_bus_cfg()
340 csicfg->clk_mode = IPU_CSI_CLK_MODE_GATED_CLK; in fill_csi_bus_cfg()
343 csicfg->ext_vsync = 0; in fill_csi_bus_cfg()
345 is_bt1120 = mbus_fmt->code == MEDIA_BUS_FMT_UYVY8_1X16 || in fill_csi_bus_cfg()
346 mbus_fmt->code == MEDIA_BUS_FMT_YUYV8_1X16; in fill_csi_bus_cfg()
347 if (V4L2_FIELD_HAS_BOTH(mbus_fmt->field) || in fill_csi_bus_cfg()
348 mbus_fmt->field == V4L2_FIELD_ALTERNATE) in fill_csi_bus_cfg()
349 csicfg->clk_mode = is_bt1120 ? in fill_csi_bus_cfg()
353 csicfg->clk_mode = is_bt1120 ? in fill_csi_bus_cfg()
359 * MIPI CSI-2 requires non gated clock mode, all other in fill_csi_bus_cfg()
360 * parameters are not applicable for MIPI CSI-2 bus. in fill_csi_bus_cfg()
362 csicfg->clk_mode = IPU_CSI_CLK_MODE_NONGATED_CLK; in fill_csi_bus_cfg()
373 ipu_csi_set_bt_interlaced_codes(struct ipu_csi *csi, in ipu_csi_set_bt_interlaced_codes() argument
382 infield = ipu_csi_translate_field(infmt->field, std); in ipu_csi_set_bt_interlaced_codes()
383 outfield = ipu_csi_translate_field(outfmt->field, std); in ipu_csi_set_bt_interlaced_codes()
386 * Write the H-V-F codes the CSI will match against the in ipu_csi_set_bt_interlaced_codes()
390 * is SEQ_TB), swap the F-bit so that the CSI will capture in ipu_csi_set_bt_interlaced_codes()
404 ipu_csi_write(csi, 0x40596 | CSI_CCIR_ERR_DET_EN, in ipu_csi_set_bt_interlaced_codes()
406 ipu_csi_write(csi, 0xD07DF, CSI_CCIR_CODE_2); in ipu_csi_set_bt_interlaced_codes()
408 dev_dbg(csi->ipu->dev, "capture field swap\n"); in ipu_csi_set_bt_interlaced_codes()
410 /* same as above but with F-bit inverted */ in ipu_csi_set_bt_interlaced_codes()
411 ipu_csi_write(csi, 0xD07DF | CSI_CCIR_ERR_DET_EN, in ipu_csi_set_bt_interlaced_codes()
413 ipu_csi_write(csi, 0x40596, CSI_CCIR_CODE_2); in ipu_csi_set_bt_interlaced_codes()
416 ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3); in ipu_csi_set_bt_interlaced_codes()
422 int ipu_csi_init_interface(struct ipu_csi *csi, in ipu_csi_init_interface() argument
438 width = infmt->width; in ipu_csi_init_interface()
439 height = infmt->height; in ipu_csi_init_interface()
440 if (infmt->field == V4L2_FIELD_ALTERNATE) in ipu_csi_init_interface()
441 height *= 2; in ipu_csi_init_interface()
456 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_init_interface()
458 ipu_csi_write(csi, data, CSI_SENS_CONF); in ipu_csi_init_interface()
464 ipu_csi_write(csi, 0x40030, CSI_CCIR_CODE_1); in ipu_csi_init_interface()
465 ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3); in ipu_csi_init_interface()
475 dev_err(csi->ipu->dev, in ipu_csi_init_interface()
477 ret = -EINVAL; in ipu_csi_init_interface()
481 ret = ipu_csi_set_bt_interlaced_codes(csi, infmt, outfmt, std); in ipu_csi_init_interface()
489 ipu_csi_write(csi, 0x40030 | CSI_CCIR_ERR_DET_EN, in ipu_csi_init_interface()
491 ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3); in ipu_csi_init_interface()
495 ipu_csi_write(csi, 0, CSI_CCIR_CODE_1); in ipu_csi_init_interface()
500 ipu_csi_write(csi, (width - 1) | ((height - 1) << 16), in ipu_csi_init_interface()
503 dev_dbg(csi->ipu->dev, "CSI_SENS_CONF = 0x%08X\n", in ipu_csi_init_interface()
504 ipu_csi_read(csi, CSI_SENS_CONF)); in ipu_csi_init_interface()
505 dev_dbg(csi->ipu->dev, "CSI_ACT_FRM_SIZE = 0x%08X\n", in ipu_csi_init_interface()
506 ipu_csi_read(csi, CSI_ACT_FRM_SIZE)); in ipu_csi_init_interface()
509 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_init_interface()
515 void ipu_csi_set_window(struct ipu_csi *csi, struct v4l2_rect *w) in ipu_csi_set_window() argument
520 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_set_window()
522 ipu_csi_write(csi, (w->width - 1) | ((w->height - 1) << 16), in ipu_csi_set_window()
525 reg = ipu_csi_read(csi, CSI_OUT_FRM_CTRL); in ipu_csi_set_window()
527 reg |= ((w->top << CSI_VSC_SHIFT) | (w->left << CSI_HSC_SHIFT)); in ipu_csi_set_window()
528 ipu_csi_write(csi, reg, CSI_OUT_FRM_CTRL); in ipu_csi_set_window()
530 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_set_window()
534 void ipu_csi_set_downsize(struct ipu_csi *csi, bool horiz, bool vert) in ipu_csi_set_downsize() argument
539 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_set_downsize()
541 reg = ipu_csi_read(csi, CSI_OUT_FRM_CTRL); in ipu_csi_set_downsize()
545 ipu_csi_write(csi, reg, CSI_OUT_FRM_CTRL); in ipu_csi_set_downsize()
547 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_set_downsize()
551 int ipu_csi_set_mipi_datatype(struct ipu_csi *csi, u32 vc, in ipu_csi_set_mipi_datatype() argument
560 return -EINVAL; in ipu_csi_set_mipi_datatype()
562 ret = mbus_code_to_bus_cfg(&cfg, mbus_fmt->code, V4L2_MBUS_CSI2_DPHY); in ipu_csi_set_mipi_datatype()
566 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_set_mipi_datatype()
568 temp = ipu_csi_read(csi, CSI_MIPI_DI); in ipu_csi_set_mipi_datatype()
571 ipu_csi_write(csi, temp, CSI_MIPI_DI); in ipu_csi_set_mipi_datatype()
573 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_set_mipi_datatype()
579 int ipu_csi_set_skip_smfc(struct ipu_csi *csi, u32 skip, in ipu_csi_set_skip_smfc() argument
586 return -EINVAL; in ipu_csi_set_skip_smfc()
588 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_set_skip_smfc()
590 temp = ipu_csi_read(csi, CSI_SKIP); in ipu_csi_set_skip_smfc()
596 ipu_csi_write(csi, temp, CSI_SKIP); in ipu_csi_set_skip_smfc()
598 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_set_skip_smfc()
604 int ipu_csi_set_dest(struct ipu_csi *csi, enum ipu_csi_dest csi_dest) in ipu_csi_set_dest() argument
614 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_set_dest()
616 csi_sens_conf = ipu_csi_read(csi, CSI_SENS_CONF); in ipu_csi_set_dest()
619 ipu_csi_write(csi, csi_sens_conf, CSI_SENS_CONF); in ipu_csi_set_dest()
621 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_set_dest()
627 int ipu_csi_enable(struct ipu_csi *csi) in ipu_csi_enable() argument
629 ipu_module_enable(csi->ipu, csi->module); in ipu_csi_enable()
635 int ipu_csi_disable(struct ipu_csi *csi) in ipu_csi_disable() argument
637 ipu_module_disable(csi->ipu, csi->module); in ipu_csi_disable()
646 struct ipu_csi *csi, *ret; in ipu_csi_get() local
649 return ERR_PTR(-EINVAL); in ipu_csi_get()
651 csi = ipu->csi_priv[id]; in ipu_csi_get()
652 ret = csi; in ipu_csi_get()
654 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_get()
656 if (csi->inuse) { in ipu_csi_get()
657 ret = ERR_PTR(-EBUSY); in ipu_csi_get()
661 csi->inuse = true; in ipu_csi_get()
663 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_get()
668 void ipu_csi_put(struct ipu_csi *csi) in ipu_csi_put() argument
672 spin_lock_irqsave(&csi->lock, flags); in ipu_csi_put()
673 csi->inuse = false; in ipu_csi_put()
674 spin_unlock_irqrestore(&csi->lock, flags); in ipu_csi_put()
681 struct ipu_csi *csi; in ipu_csi_init() local
684 return -ENODEV; in ipu_csi_init()
686 csi = devm_kzalloc(dev, sizeof(*csi), GFP_KERNEL); in ipu_csi_init()
687 if (!csi) in ipu_csi_init()
688 return -ENOMEM; in ipu_csi_init()
690 ipu->csi_priv[id] = csi; in ipu_csi_init()
692 spin_lock_init(&csi->lock); in ipu_csi_init()
693 csi->module = module; in ipu_csi_init()
694 csi->id = id; in ipu_csi_init()
695 csi->clk_ipu = clk_ipu; in ipu_csi_init()
696 csi->base = devm_ioremap(dev, base, PAGE_SIZE); in ipu_csi_init()
697 if (!csi->base) in ipu_csi_init()
698 return -ENOMEM; in ipu_csi_init()
700 dev_dbg(dev, "CSI%d base: 0x%08lx remapped to %p\n", in ipu_csi_init()
701 id, base, csi->base); in ipu_csi_init()
702 csi->ipu = ipu; in ipu_csi_init()
711 void ipu_csi_dump(struct ipu_csi *csi) in ipu_csi_dump() argument
713 dev_dbg(csi->ipu->dev, "CSI_SENS_CONF: %08x\n", in ipu_csi_dump()
714 ipu_csi_read(csi, CSI_SENS_CONF)); in ipu_csi_dump()
715 dev_dbg(csi->ipu->dev, "CSI_SENS_FRM_SIZE: %08x\n", in ipu_csi_dump()
716 ipu_csi_read(csi, CSI_SENS_FRM_SIZE)); in ipu_csi_dump()
717 dev_dbg(csi->ipu->dev, "CSI_ACT_FRM_SIZE: %08x\n", in ipu_csi_dump()
718 ipu_csi_read(csi, CSI_ACT_FRM_SIZE)); in ipu_csi_dump()
719 dev_dbg(csi->ipu->dev, "CSI_OUT_FRM_CTRL: %08x\n", in ipu_csi_dump()
720 ipu_csi_read(csi, CSI_OUT_FRM_CTRL)); in ipu_csi_dump()
721 dev_dbg(csi->ipu->dev, "CSI_TST_CTRL: %08x\n", in ipu_csi_dump()
722 ipu_csi_read(csi, CSI_TST_CTRL)); in ipu_csi_dump()
723 dev_dbg(csi->ipu->dev, "CSI_CCIR_CODE_1: %08x\n", in ipu_csi_dump()
724 ipu_csi_read(csi, CSI_CCIR_CODE_1)); in ipu_csi_dump()
725 dev_dbg(csi->ipu->dev, "CSI_CCIR_CODE_2: %08x\n", in ipu_csi_dump()
726 ipu_csi_read(csi, CSI_CCIR_CODE_2)); in ipu_csi_dump()
727 dev_dbg(csi->ipu->dev, "CSI_CCIR_CODE_3: %08x\n", in ipu_csi_dump()
728 ipu_csi_read(csi, CSI_CCIR_CODE_3)); in ipu_csi_dump()
729 dev_dbg(csi->ipu->dev, "CSI_MIPI_DI: %08x\n", in ipu_csi_dump()
730 ipu_csi_read(csi, CSI_MIPI_DI)); in ipu_csi_dump()
731 dev_dbg(csi->ipu->dev, "CSI_SKIP: %08x\n", in ipu_csi_dump()
732 ipu_csi_read(csi, CSI_SKIP)); in ipu_csi_dump()