drivers/media/platform/nxp/imx8-isi/imx8-isi-gasket.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright 2019-2023 NXP
   4  */
   5
   6 #include <linux/regmap.h>
   7
   8 #include <media/mipi-csi2.h>
   9
  10 #include "imx8-isi-core.h"
  11
  12 /* -----------------------------------------------------------------------------
  13  * i.MX8MN and i.MX8MP gasket
  14  */
  15
  16 #define GASKET_BASE(n)                          (0x0060 + (n) * 0x30)
  17
  18 #define GASKET_CTRL                             0x0000
  19 #define GASKET_CTRL_DATA_TYPE(dt)               ((dt) << 8)
  20 #define GASKET_CTRL_DATA_TYPE_MASK              (0x3f << 8)
  21 #define GASKET_CTRL_DUAL_COMP_ENABLE            BIT(1)
  22 #define GASKET_CTRL_ENABLE                      BIT(0)
  23
  24 #define GASKET_HSIZE                            0x0004
  25 #define GASKET_VSIZE                            0x0008
  26
  27 static void mxc_imx8_gasket_enable(struct mxc_isi_dev *isi,
  28                                    const struct v4l2_mbus_frame_desc *fd,
  29                                    const struct v4l2_mbus_framefmt *fmt,
  30                                    const unsigned int port)
  31 {
  32         u32 val;
  33
  34         regmap_write(isi->gasket, GASKET_BASE(port) + GASKET_HSIZE, fmt->width);
  35         regmap_write(isi->gasket, GASKET_BASE(port) + GASKET_VSIZE, fmt->height);
  36
  37         val = GASKET_CTRL_DATA_TYPE(fd->entry[0].bus.csi2.dt);
  38         if (fd->entry[0].bus.csi2.dt == MIPI_CSI2_DT_YUV422_8B)
  39                 val |= GASKET_CTRL_DUAL_COMP_ENABLE;
  40
  41         val |= GASKET_CTRL_ENABLE;
  42         regmap_write(isi->gasket, GASKET_BASE(port) + GASKET_CTRL, val);
  43 }
  44
  45 static void mxc_imx8_gasket_disable(struct mxc_isi_dev *isi,
  46                                     const unsigned int port)
  47 {
  48         regmap_write(isi->gasket, GASKET_BASE(port) + GASKET_CTRL, 0);
  49 }
  50
  51 const struct mxc_gasket_ops mxc_imx8_gasket_ops = {
  52         .enable = mxc_imx8_gasket_enable,
  53         .disable = mxc_imx8_gasket_disable,
  54 };
  55
  56 /* -----------------------------------------------------------------------------
  57  * i.MX93 gasket
  58  */
  59
  60 #define DISP_MIX_CAMERA_MUX                     0x30
  61 #define DISP_MIX_CAMERA_MUX_DATA_TYPE(x)        (((x) & 0x3f) << 3)
  62 #define DISP_MIX_CAMERA_MUX_GASKET_ENABLE       BIT(16)
  63
  64 static void mxc_imx93_gasket_enable(struct mxc_isi_dev *isi,
  65                                     const struct v4l2_mbus_frame_desc *fd,
  66                                     const struct v4l2_mbus_framefmt *fmt,
  67                                     const unsigned int port)
  68 {
  69         u32 val;
  70
  71         val = DISP_MIX_CAMERA_MUX_DATA_TYPE(fd->entry[0].bus.csi2.dt);
  72         val |= DISP_MIX_CAMERA_MUX_GASKET_ENABLE;
  73         regmap_write(isi->gasket, DISP_MIX_CAMERA_MUX, val);
  74 }
  75
  76 static void mxc_imx93_gasket_disable(struct mxc_isi_dev *isi,
  77                                      unsigned int port)
  78 {
  79         regmap_write(isi->gasket, DISP_MIX_CAMERA_MUX, 0);
  80 }
  81
  82 const struct mxc_gasket_ops mxc_imx93_gasket_ops = {
  83         .enable = mxc_imx93_gasket_enable,
  84         .disable = mxc_imx93_gasket_disable,
  85 };