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
mxc_imx8_gasket_enable(struct mxc_isi_dev * isi,const struct v4l2_mbus_frame_desc * fd,const struct v4l2_mbus_framefmt * fmt,const unsigned int port)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
mxc_imx8_gasket_disable(struct mxc_isi_dev * isi,const unsigned int port)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
mxc_imx93_gasket_enable(struct mxc_isi_dev * isi,const struct v4l2_mbus_frame_desc * fd,const struct v4l2_mbus_framefmt * fmt,const unsigned int port)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
mxc_imx93_gasket_disable(struct mxc_isi_dev * isi,unsigned int port)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 };
86