86 lines · c
1// SPDX-License-Identifier: GPL-2.02/*3 * Copyright 2019-2023 NXP4 */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 gasket14 */15 16#define GASKET_BASE(n) (0x0060 + (n) * 0x30)17 18#define GASKET_CTRL 0x000019#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 0x000425#define GASKET_VSIZE 0x000826 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 gasket58 */59 60#define DISP_MIX_CAMERA_MUX 0x3061#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