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
27static 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
45static 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
51const 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
64static 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
76static 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
82const struct mxc_gasket_ops mxc_imx93_gasket_ops = {
83	.enable = mxc_imx93_gasket_enable,
84	.disable = mxc_imx93_gasket_disable,
85};
86