On Tue, Sep 08, 2020 at 10:06:03AM +0200, Neil Armstrong wrote: > Hi, > > On 07/09/2020 20:03, Daniel Vetter wrote: > > On Mon, Sep 07, 2020 at 11:03:29AM +0200, Neil Armstrong wrote: > >> On 07/09/2020 10:44, Daniel Vetter wrote: > >>> On Mon, Sep 07, 2020 at 10:43:51AM +0200, Daniel Vetter wrote: > >>>> On Mon, Sep 07, 2020 at 10:18:25AM +0200, Neil Armstrong wrote: > >>>>> The Amlogic AXg SoCs embeds a Synopsys DW-MIPI-DSI transceiver (ver 1.21a), with a custom > >>>>> glue managing the IP resets, clock and data input similar to the DW-HDMI Glue on other > >>>>> Amlogic SoCs. > >>>>> > >>>>> This adds support for the Glue managing the transceiver, mimicing the init flow provided > >>>>> by Amlogic to setup the ENCl encoder, the glue, the transceiver, the digital D-PHY and the > >>>>> Analog PHY in the proper way. > >>>>> > >>>>> The DW-MIPI-DSI transceiver + D-PHY are directly clocked by the VCLK2 clock, which pixel clock > >>>>> is derived and feeds the ENCL encoder and the VIU pixel reader. > >>>>> > >>>>> An optional "MEAS" clock can be enabled to measure the delay between each vsync feeding the > >>>>> DW-MIPI-DSI transceiver. > >>>>> > >>>>> Signed-off-by: Neil Armstrong <narmstrong@xxxxxxxxxxxx> > >>>> > >>>> More dw-hdmi drivers which aren't bridges but components, and the thing is > >>>> still midlayer-y as heck :-/ > >>> > >>> *dw-dsi, but really they both work the same way and should both be fixed > >>> ... > >> > >> They are bridges but since they have platform-dependent code due to theirs's generic IP > >> nature, they need to be intanciated by components to sync with the platform code. > > > > Yeah that's how it currently works, but there's not much reason why it > > needs to work like that. That platform glue code can also be put behind > > the drm_bridge abstraction, and we could use the normal dt based bridge > > lookup like for everything else. > > > > Afaiui the only reason dw-* bridge drivers work like that is because for > > historical reasons we only had component.c at first, and none of the more > > fancy dynamic bridge lookup. So would be really good to switch this all > > over to a proper&clean bridge abstraction, and not leak everything around. > > Does it mean we should avoit using components, right ? Yup, at least when there's an established specific mechanism to handle cross-driver interactions/EPROBE_DEFER. So if you want a drm_panel or drm_bridge or a clock or i2c or anything else standardized like that, no component.c please. That's just for the driver-specific glue when you have entirely IP-specific way of building up a driver from components, which will never be reused outside of that overall driver. Hence why dw-* using components is rather uncool. > > I've typed up what I think should be the way forward a few times already, > > but thus far not even the todo.rst entry materialized: > > > > https://lore.kernel.org/dri-devel/20200430135841.GE10381@phenom.ffwll.local/ > > > > If everyone is always about "not in my patch series" it'll never happen. > > Today, the dw-mipi-dsi and dw-mipi-hdmi has mandatory callbacks to implement > vendor specific features, like : > - hdmi/dsi phy handling when mixed into the glue/custom/synopsys but with platform specific values > - platform specific mode validation > - hpd setup => could use laurent's work here with no_connector, but how do we handle rxsense ??? > - dsi timings/lane mbps ? these are platform phy specific > > For amlogic, I can split the "component" code handling venc/vclk into a primary bridge and add a > secondary driver only handling the glue around dw-mipi-dsi/dw-mipi-hdmi, would that be a good start ? I think what we should do here: - type up todo.rst with the overall structure we want to aim for, i.e. where is the code, who sets up what, how are the bridges bound into the overall driver. - demidlayer dw-* enough so that the callbacks are gone, and it becomes more a toolbox/library for building a dw-* driver. Maybe we're there already. - All new drivers then need to use the toolbox and have everything behind a drm_bridge driver in drm/bridge/, with just default binding exposed to drivers, no EXPORT_SYMBOL at all. Also no exported symbols used, this should all be directly linked into the dw-*.ko imo and treated as internals. - We might need to split the header files to make that clean enough. - Once all existing dw-* users are converted, we ditch the EXPORT_SYMBOL stuff completely (since I expect we'll just have one overall dw-dsi.ko module with all bridge driver variants). Cheers, Daniel > > Neil > > > > > Cheers, Daniel > > > > > >> > >> Neil > >> > >>> > >>>> > >>>> Can we try to fix this? There's a ton of this going on, and the more we > >>>> add the old fashioned way the harder this gets to fix up for real. > >>>> -Daniel > >>>> > >>>>> --- > >>>>> drivers/gpu/drm/meson/Kconfig | 7 + > >>>>> drivers/gpu/drm/meson/Makefile | 1 + > >>>>> drivers/gpu/drm/meson/meson_dw_mipi_dsi.c | 562 ++++++++++++++++++++++ > >>>>> 3 files changed, 570 insertions(+) > >>>>> create mode 100644 drivers/gpu/drm/meson/meson_dw_mipi_dsi.c > >>>>> > >>>>> diff --git a/drivers/gpu/drm/meson/Kconfig b/drivers/gpu/drm/meson/Kconfig > >>>>> index 9f9281dd49f8..385f6f23839b 100644 > >>>>> --- a/drivers/gpu/drm/meson/Kconfig > >>>>> +++ b/drivers/gpu/drm/meson/Kconfig > >>>>> @@ -16,3 +16,10 @@ config DRM_MESON_DW_HDMI > >>>>> default y if DRM_MESON > >>>>> select DRM_DW_HDMI > >>>>> imply DRM_DW_HDMI_I2S_AUDIO > >>>>> + > >>>>> +config DRM_MESON_DW_MIPI_DSI > >>>>> + tristate "MIPI DSI Synopsys Controller support for Amlogic Meson Display" > >>>>> + depends on DRM_MESON > >>>>> + default y if DRM_MESON > >>>>> + select DRM_DW_MIPI_DSI > >>>>> + select GENERIC_PHY_MIPI_DPHY > >>>>> diff --git a/drivers/gpu/drm/meson/Makefile b/drivers/gpu/drm/meson/Makefile > >>>>> index 28a519cdf66b..2cc870e91182 100644 > >>>>> --- a/drivers/gpu/drm/meson/Makefile > >>>>> +++ b/drivers/gpu/drm/meson/Makefile > >>>>> @@ -5,3 +5,4 @@ meson-drm-y += meson_rdma.o meson_osd_afbcd.o > >>>>> > >>>>> obj-$(CONFIG_DRM_MESON) += meson-drm.o > >>>>> obj-$(CONFIG_DRM_MESON_DW_HDMI) += meson_dw_hdmi.o > >>>>> +obj-$(CONFIG_DRM_MESON_DW_MIPI_DSI) += meson_dw_mipi_dsi.o > >>>>> diff --git a/drivers/gpu/drm/meson/meson_dw_mipi_dsi.c b/drivers/gpu/drm/meson/meson_dw_mipi_dsi.c > >>>>> new file mode 100644 > >>>>> index 000000000000..bbe1294fce7c > >>>>> --- /dev/null > >>>>> +++ b/drivers/gpu/drm/meson/meson_dw_mipi_dsi.c > >>>>> @@ -0,0 +1,562 @@ > >>>>> +// SPDX-License-Identifier: GPL-2.0-or-later > >>>>> +/* > >>>>> + * Copyright (C) 2016 BayLibre, SAS > >>>>> + * Author: Neil Armstrong <narmstrong@xxxxxxxxxxxx> > >>>>> + * Copyright (C) 2015 Amlogic, Inc. All rights reserved. > >>>>> + */ > >>>>> + > >>>>> +#include <linux/clk.h> > >>>>> +#include <linux/component.h> > >>>>> +#include <linux/kernel.h> > >>>>> +#include <linux/module.h> > >>>>> +#include <linux/of_device.h> > >>>>> +#include <linux/of_graph.h> > >>>>> +#include <linux/reset.h> > >>>>> +#include <linux/phy/phy.h> > >>>>> + > >>>>> +#include <video/mipi_display.h> > >>>>> + > >>>>> +#include <drm/bridge/dw_mipi_dsi.h> > >>>>> +#include <drm/drm_mipi_dsi.h> > >>>>> + > >>>>> +#include <drm/drm_atomic_helper.h> > >>>>> +#include <drm/drm_device.h> > >>>>> +#include <drm/drm_probe_helper.h> > >>>>> +#include <drm/drm_print.h> > >>>>> + > >>>>> +#include "meson_drv.h" > >>>>> +#include "meson_dw_mipi_dsi.h" > >>>>> +#include "meson_registers.h" > >>>>> +#include "meson_venc.h" > >>>>> + > >>>>> +#define DRIVER_NAME "meson-dw-mipi-dsi" > >>>>> +#define DRIVER_DESC "Amlogic Meson MIPI-DSI DRM driver" > >>>>> + > >>>>> +/* MIPI DSI/VENC Color Format Definitions */ > >>>>> +#define MIPI_DSI_VENC_COLOR_30B 0x0 > >>>>> +#define MIPI_DSI_VENC_COLOR_24B 0x1 > >>>>> +#define MIPI_DSI_VENC_COLOR_18B 0x2 > >>>>> +#define MIPI_DSI_VENC_COLOR_16B 0x3 > >>>>> + > >>>>> +#define COLOR_16BIT_CFG_1 0x0 > >>>>> +#define COLOR_16BIT_CFG_2 0x1 > >>>>> +#define COLOR_16BIT_CFG_3 0x2 > >>>>> +#define COLOR_18BIT_CFG_1 0x3 > >>>>> +#define COLOR_18BIT_CFG_2 0x4 > >>>>> +#define COLOR_24BIT 0x5 > >>>>> +#define COLOR_20BIT_LOOSE 0x6 > >>>>> +#define COLOR_24_BIT_YCBCR 0x7 > >>>>> +#define COLOR_16BIT_YCBCR 0x8 > >>>>> +#define COLOR_30BIT 0x9 > >>>>> +#define COLOR_36BIT 0xa > >>>>> +#define COLOR_12BIT 0xb > >>>>> +#define COLOR_RGB_111 0xc > >>>>> +#define COLOR_RGB_332 0xd > >>>>> +#define COLOR_RGB_444 0xe > >>>>> + > >>>>> +/* MIPI DSI Relative REGISTERs Definitions */ > >>>>> +/* For MIPI_DSI_TOP_CNTL */ > >>>>> +#define BIT_DPI_COLOR_MODE 20 > >>>>> +#define BIT_IN_COLOR_MODE 16 > >>>>> +#define BIT_CHROMA_SUBSAMPLE 14 > >>>>> +#define BIT_COMP2_SEL 12 > >>>>> +#define BIT_COMP1_SEL 10 > >>>>> +#define BIT_COMP0_SEL 8 > >>>>> +#define BIT_DE_POL 6 > >>>>> +#define BIT_HSYNC_POL 5 > >>>>> +#define BIT_VSYNC_POL 4 > >>>>> +#define BIT_DPICOLORM 3 > >>>>> +#define BIT_DPISHUTDN 2 > >>>>> +#define BIT_EDPITE_INTR_PULSE 1 > >>>>> +#define BIT_ERR_INTR_PULSE 0 > >>>>> + > >>>>> +/* HHI Registers */ > >>>>> +#define HHI_VIID_CLK_DIV 0x128 /* 0x4a offset in data sheet */ > >>>>> +#define VCLK2_DIV_MASK 0xff > >>>>> +#define VCLK2_DIV_EN BIT(16) > >>>>> +#define VCLK2_DIV_RESET BIT(17) > >>>>> +#define CTS_ENCL_SEL_MASK (0xf << 12) > >>>>> +#define CTS_ENCL_SEL_SHIFT 12 > >>>>> +#define HHI_VIID_CLK_CNTL 0x12c /* 0x4b offset in data sheet */ > >>>>> +#define VCLK2_EN BIT(19) > >>>>> +#define VCLK2_SEL_MASK (0x7 << 16) > >>>>> +#define VCLK2_SEL_SHIFT 16 > >>>>> +#define VCLK2_SOFT_RESET BIT(15) > >>>>> +#define VCLK2_DIV1_EN BIT(0) > >>>>> +#define HHI_VID_CLK_CNTL2 0x194 /* 0x65 offset in data sheet */ > >>>>> +#define CTS_ENCL_EN BIT(3) > >>>>> + > >>>>> +/** > >>>>> + * DOC: MIPI DSI > >>>>> + * > >>>>> + */ > >>>>> + > >>>>> +struct meson_dw_mipi_dsi { > >>>>> + struct drm_encoder encoder; > >>>>> + struct meson_drm *priv; > >>>>> + struct device *dev; > >>>>> + void __iomem *base; > >>>>> + struct phy *phy; > >>>>> + union phy_configure_opts phy_opts; > >>>>> + struct dw_mipi_dsi *dmd; > >>>>> + struct dw_mipi_dsi_plat_data pdata; > >>>>> + struct mipi_dsi_device *dsi_device; > >>>>> + unsigned long mode_flags; > >>>>> + struct clk *px_clk; > >>>>> +}; > >>>>> +#define encoder_to_meson_dw_mipi_dsi(x) \ > >>>>> + container_of(x, struct meson_dw_mipi_dsi, encoder) > >>>>> + > >>>>> +static void dw_mipi_dsi_set_vclk(struct meson_dw_mipi_dsi *mipi_dsi, > >>>>> + struct drm_display_mode *mode) > >>>>> +{ > >>>>> + struct meson_drm *priv = mipi_dsi->priv; > >>>>> + unsigned int vclk2_div; > >>>>> + unsigned int pll_rate; > >>>>> + int ret; > >>>>> + > >>>>> + pll_rate = mipi_dsi->phy_opts.mipi_dphy.hs_clk_rate; > >>>>> + vclk2_div = pll_rate / (mode->clock * 1000); > >>>>> + > >>>>> + ret = clk_set_rate(mipi_dsi->px_clk, pll_rate); > >>>>> + if (ret) { > >>>>> + pr_err("Failed to set DSI PLL rate %lu\n", > >>>>> + mipi_dsi->phy_opts.mipi_dphy.hs_clk_rate); > >>>>> + > >>>>> + return; > >>>>> + } > >>>>> + > >>>>> + /* Disable VCLK2 */ > >>>>> + regmap_update_bits(priv->hhi, HHI_VIID_CLK_CNTL, VCLK2_EN, 0); > >>>>> + > >>>>> + /* Setup the VCLK2 divider value */ > >>>>> + regmap_update_bits(priv->hhi, HHI_VIID_CLK_DIV, > >>>>> + VCLK2_DIV_MASK, (vclk2_div - 1)); > >>>>> + > >>>>> + /* select gp0 for vclk2 */ > >>>>> + regmap_update_bits(priv->hhi, HHI_VIID_CLK_CNTL, > >>>>> + VCLK2_SEL_MASK, (0 << VCLK2_SEL_SHIFT)); > >>>>> + > >>>>> + /* enable vclk2 gate */ > >>>>> + regmap_update_bits(priv->hhi, HHI_VIID_CLK_CNTL, VCLK2_EN, VCLK2_EN); > >>>>> + > >>>>> + /* select vclk2_div1 for encl */ > >>>>> + regmap_update_bits(priv->hhi, HHI_VIID_CLK_DIV, > >>>>> + CTS_ENCL_SEL_MASK, (8 << CTS_ENCL_SEL_SHIFT)); > >>>>> + > >>>>> + /* release vclk2_div_reset and enable vclk2_div */ > >>>>> + regmap_update_bits(priv->hhi, HHI_VIID_CLK_DIV, > >>>>> + VCLK2_DIV_EN | VCLK2_DIV_RESET, VCLK2_DIV_EN); > >>>>> + > >>>>> + /* enable vclk2_div1 gate */ > >>>>> + regmap_update_bits(priv->hhi, HHI_VIID_CLK_CNTL, > >>>>> + VCLK2_DIV1_EN, VCLK2_DIV1_EN); > >>>>> + > >>>>> + /* reset vclk2 */ > >>>>> + regmap_update_bits(priv->hhi, HHI_VIID_CLK_CNTL, > >>>>> + VCLK2_SOFT_RESET, VCLK2_SOFT_RESET); > >>>>> + regmap_update_bits(priv->hhi, HHI_VIID_CLK_CNTL, > >>>>> + VCLK2_SOFT_RESET, 0); > >>>>> + > >>>>> + /* enable encl_clk */ > >>>>> + regmap_update_bits(priv->hhi, HHI_VID_CLK_CNTL2, > >>>>> + CTS_ENCL_EN, CTS_ENCL_EN); > >>>>> + > >>>>> + usleep_range(10000, 11000); > >>>>> +} > >>>>> + > >>>>> +static int dw_mipi_dsi_phy_init(void *priv_data) > >>>>> +{ > >>>>> + struct meson_dw_mipi_dsi *mipi_dsi = priv_data; > >>>>> + struct meson_drm *priv = mipi_dsi->priv; > >>>>> + > >>>>> + > >>>>> + phy_power_on(mipi_dsi->phy); > >>>>> + > >>>>> + writel_relaxed(1, priv->io_base + _REG(ENCL_VIDEO_EN)); > >>>>> + > >>>>> + return 0; > >>>>> +} > >>>>> + > >>>>> +static void dw_mipi_dsi_phy_power_off(void *priv_data) > >>>>> +{ > >>>>> + struct meson_dw_mipi_dsi *mipi_dsi = priv_data; > >>>>> + > >>>>> + phy_power_off(mipi_dsi->phy); > >>>>> +} > >>>>> + > >>>>> +static int > >>>>> +dw_mipi_dsi_get_lane_mbps(void *priv_data, const struct drm_display_mode *mode, > >>>>> + unsigned long mode_flags, u32 lanes, u32 format, > >>>>> + unsigned int *lane_mbps) > >>>>> +{ > >>>>> + struct meson_dw_mipi_dsi *mipi_dsi = priv_data; > >>>>> + > >>>>> + *lane_mbps = mipi_dsi->phy_opts.mipi_dphy.hs_clk_rate / 1000000; > >>>>> + > >>>>> + return 0; > >>>>> +} > >>>>> + > >>>>> +static int > >>>>> +dw_mipi_dsi_phy_get_timing(void *priv_data, unsigned int lane_mbps, > >>>>> + struct dw_mipi_dsi_dphy_timing *timing) > >>>>> +{ > >>>>> + /* TOFIX handle other cases */ > >>>>> + > >>>>> + timing->clk_lp2hs = 37; > >>>>> + timing->clk_hs2lp = 135; > >>>>> + timing->data_lp2hs = 50; > >>>>> + timing->data_hs2lp = 3; > >>>>> + > >>>>> + return 0; > >>>>> +} > >>>>> + > >>>>> +static int > >>>>> +dw_mipi_dsi_get_esc_clk_rate(void *priv_data, unsigned int *esc_clk_rate) > >>>>> +{ > >>>>> + *esc_clk_rate = 4; /* Mhz */ > >>>>> + > >>>>> + return 0; > >>>>> +} > >>>>> + > >>>>> +static const struct dw_mipi_dsi_phy_ops meson_dw_mipi_dsi_phy_ops = { > >>>>> + .init = dw_mipi_dsi_phy_init, > >>>>> + .power_off = dw_mipi_dsi_phy_power_off, > >>>>> + .get_lane_mbps = dw_mipi_dsi_get_lane_mbps, > >>>>> + .get_timing = dw_mipi_dsi_phy_get_timing, > >>>>> + .get_esc_clk_rate = dw_mipi_dsi_get_esc_clk_rate, > >>>>> +}; > >>>>> + > >>>>> +/* Encoder */ > >>>>> + > >>>>> +static void meson_mipi_dsi_encoder_destroy(struct drm_encoder *encoder) > >>>>> +{ > >>>>> + drm_encoder_cleanup(encoder); > >>>>> +} > >>>>> + > >>>>> +static const struct drm_encoder_funcs meson_mipi_dsi_encoder_funcs = { > >>>>> + .destroy = meson_mipi_dsi_encoder_destroy, > >>>>> +}; > >>>>> + > >>>>> +static int meson_mipi_dsi_encoder_atomic_check(struct drm_encoder *encoder, > >>>>> + struct drm_crtc_state *crtc_state, > >>>>> + struct drm_connector_state *conn_state) > >>>>> +{ > >>>>> + struct meson_dw_mipi_dsi *mipi_dsi = > >>>>> + encoder_to_meson_dw_mipi_dsi(encoder); > >>>>> + > >>>>> + switch (mipi_dsi->dsi_device->format) { > >>>>> + case MIPI_DSI_FMT_RGB888: > >>>>> + break; > >>>>> + case MIPI_DSI_FMT_RGB666: > >>>>> + break; > >>>>> + case MIPI_DSI_FMT_RGB666_PACKED: > >>>>> + case MIPI_DSI_FMT_RGB565: > >>>>> + default: > >>>>> + DRM_DEV_ERROR(mipi_dsi->dev, > >>>>> + "invalid pixel format %d\n", > >>>>> + mipi_dsi->dsi_device->format); > >>>>> + return -EINVAL; > >>>>> + }; > >>>>> + > >>>>> + return 0; > >>>>> +} > >>>>> + > >>>>> +static void meson_mipi_dsi_encoder_disable(struct drm_encoder *encoder) > >>>>> +{ > >>>>> + struct meson_dw_mipi_dsi *mipi_dsi = > >>>>> + encoder_to_meson_dw_mipi_dsi(encoder); > >>>>> + struct meson_drm *priv = mipi_dsi->priv; > >>>>> + > >>>>> + writel_relaxed(0, priv->io_base + _REG(ENCL_VIDEO_EN)); > >>>>> +} > >>>>> + > >>>>> +static void meson_mipi_dsi_encoder_enable(struct drm_encoder *encoder) > >>>>> +{ > >>>>> + struct meson_dw_mipi_dsi *mipi_dsi = > >>>>> + encoder_to_meson_dw_mipi_dsi(encoder); > >>>>> + struct meson_drm *priv = mipi_dsi->priv; > >>>>> + > >>>>> + writel_bits_relaxed(BIT(3), BIT(3), > >>>>> + priv->io_base + _REG(ENCL_VIDEO_MODE_ADV)); > >>>>> + writel_relaxed(0, priv->io_base + _REG(ENCL_TST_EN)); > >>>>> +} > >>>>> + > >>>>> +static void meson_dw_mipi_dsi_init(struct meson_dw_mipi_dsi *mipi_dsi) > >>>>> +{ > >>>>> + writel_relaxed((1 << 4) | (1 << 5) | (0 << 6), > >>>>> + mipi_dsi->base + MIPI_DSI_TOP_CNTL); > >>>>> + > >>>>> + writel_bits_relaxed(0xf, 0xf, > >>>>> + mipi_dsi->base + MIPI_DSI_TOP_SW_RESET); > >>>>> + writel_bits_relaxed(0xf, 0, > >>>>> + mipi_dsi->base + MIPI_DSI_TOP_SW_RESET); > >>>>> + > >>>>> + writel_bits_relaxed(0x3, 0x3, > >>>>> + mipi_dsi->base + MIPI_DSI_TOP_CLK_CNTL); > >>>>> + > >>>>> + writel_relaxed(0, mipi_dsi->base + MIPI_DSI_TOP_MEM_PD); > >>>>> +} > >>>>> + > >>>>> +static void meson_mipi_dsi_encoder_mode_set(struct drm_encoder *encoder, > >>>>> + struct drm_display_mode *mode, > >>>>> + struct drm_display_mode *adjusted_mode) > >>>>> +{ > >>>>> + struct meson_dw_mipi_dsi *mipi_dsi = encoder_to_meson_dw_mipi_dsi(encoder); > >>>>> + unsigned int dpi_data_format, venc_data_width; > >>>>> + struct meson_drm *priv = mipi_dsi->priv; > >>>>> + int bpp; > >>>>> + u32 reg; > >>>>> + > >>>>> + mipi_dsi->mode_flags = mode->flags; > >>>>> + > >>>>> + bpp = mipi_dsi_pixel_format_to_bpp(mipi_dsi->dsi_device->format); > >>>>> + > >>>>> + phy_mipi_dphy_get_default_config(mode->clock * 1000, > >>>>> + bpp, mipi_dsi->dsi_device->lanes, > >>>>> + &mipi_dsi->phy_opts.mipi_dphy); > >>>>> + > >>>>> + phy_configure(mipi_dsi->phy, &mipi_dsi->phy_opts); > >>>>> + > >>>>> + switch (mipi_dsi->dsi_device->format) { > >>>>> + case MIPI_DSI_FMT_RGB888: > >>>>> + dpi_data_format = COLOR_24BIT; > >>>>> + venc_data_width = MIPI_DSI_VENC_COLOR_24B; > >>>>> + break; > >>>>> + case MIPI_DSI_FMT_RGB666: > >>>>> + dpi_data_format = COLOR_18BIT_CFG_2; > >>>>> + venc_data_width = MIPI_DSI_VENC_COLOR_18B; > >>>>> + break; > >>>>> + case MIPI_DSI_FMT_RGB666_PACKED: > >>>>> + case MIPI_DSI_FMT_RGB565: > >>>>> + /* invalid */ > >>>>> + break; > >>>>> + }; > >>>>> + > >>>>> + dw_mipi_dsi_set_vclk(mipi_dsi, mode); > >>>>> + meson_venc_mipi_dsi_mode_set(priv, mode); > >>>>> + > >>>>> + meson_encl_load_gamma(priv); > >>>>> + > >>>>> + writel_relaxed(0, priv->io_base + _REG(ENCL_VIDEO_EN)); > >>>>> + > >>>>> + meson_dw_mipi_dsi_init(mipi_dsi); > >>>>> + > >>>>> + /* Configure Set color format for DPI register */ > >>>>> + reg = readl_relaxed(mipi_dsi->base + MIPI_DSI_TOP_CNTL) & > >>>>> + ~(0xf<<BIT_DPI_COLOR_MODE) & > >>>>> + ~(0x7<<BIT_IN_COLOR_MODE) & > >>>>> + ~(0x3<<BIT_CHROMA_SUBSAMPLE); > >>>>> + > >>>>> + writel_relaxed(reg | > >>>>> + (dpi_data_format << BIT_DPI_COLOR_MODE) | > >>>>> + (venc_data_width << BIT_IN_COLOR_MODE) | > >>>>> + 0 << BIT_COMP0_SEL | > >>>>> + 1 << BIT_COMP1_SEL | > >>>>> + 2 << BIT_COMP2_SEL | > >>>>> + (mipi_dsi->mode_flags & DRM_MODE_FLAG_NHSYNC ? 0 : BIT(BIT_HSYNC_POL)) | > >>>>> + (mipi_dsi->mode_flags & DRM_MODE_FLAG_NVSYNC ? 0 : BIT(BIT_VSYNC_POL)), > >>>>> + mipi_dsi->base + MIPI_DSI_TOP_CNTL); > >>>>> +} > >>>>> + > >>>>> +static const struct drm_encoder_helper_funcs > >>>>> + meson_mipi_dsi_encoder_helper_funcs = { > >>>>> + .atomic_check = meson_mipi_dsi_encoder_atomic_check, > >>>>> + .disable = meson_mipi_dsi_encoder_disable, > >>>>> + .enable = meson_mipi_dsi_encoder_enable, > >>>>> + .mode_set = meson_mipi_dsi_encoder_mode_set, > >>>>> +}; > >>>>> + > >>>>> +static int meson_dw_mipi_dsi_bind(struct device *dev, struct device *master, > >>>>> + void *data) > >>>>> +{ > >>>>> + struct meson_dw_mipi_dsi *mipi_dsi = dev_get_drvdata(dev); > >>>>> + struct drm_device *drm = data; > >>>>> + struct meson_drm *priv = drm->dev_private; > >>>>> + struct drm_encoder *encoder; > >>>>> + int ret; > >>>>> + > >>>>> + /* Check before if we are supposed to have a sub-device... */ > >>>>> + if (!mipi_dsi->dsi_device) > >>>>> + return -EPROBE_DEFER; > >>>>> + > >>>>> + encoder = &mipi_dsi->encoder; > >>>>> + mipi_dsi->priv = priv; > >>>>> + > >>>>> + /* Encoder */ > >>>>> + ret = drm_encoder_init(drm, encoder, &meson_mipi_dsi_encoder_funcs, > >>>>> + DRM_MODE_ENCODER_DSI, "meson_mipi_dsi"); > >>>>> + if (ret) { > >>>>> + dev_err(priv->dev, "Failed to init DSI encoder\n"); > >>>>> + return ret; > >>>>> + } > >>>>> + > >>>>> + drm_encoder_helper_add(encoder, &meson_mipi_dsi_encoder_helper_funcs); > >>>>> + > >>>>> + encoder->possible_crtcs = BIT(0); > >>>>> + > >>>>> + ret = dw_mipi_dsi_bind(mipi_dsi->dmd, encoder); > >>>>> + if (ret) { > >>>>> + DRM_DEV_ERROR(dev, "Failed to bind: %d\n", ret); > >>>>> + return ret; > >>>>> + } > >>>>> + > >>>>> + phy_init(mipi_dsi->phy); > >>>>> + > >>>>> + return 0; > >>>>> +} > >>>>> + > >>>>> +static void meson_dw_mipi_dsi_unbind(struct device *dev, struct device *master, > >>>>> + void *data) > >>>>> +{ > >>>>> + struct meson_dw_mipi_dsi *mipi_dsi = dev_get_drvdata(dev); > >>>>> + > >>>>> + dw_mipi_dsi_remove(mipi_dsi->dmd); > >>>>> + > >>>>> + phy_exit(mipi_dsi->phy); > >>>>> +} > >>>>> + > >>>>> +static const struct component_ops meson_dw_mipi_dsi_ops = { > >>>>> + .bind = meson_dw_mipi_dsi_bind, > >>>>> + .unbind = meson_dw_mipi_dsi_unbind, > >>>>> +}; > >>>>> + > >>>>> +static int meson_dw_mipi_dsi_host_attach(void *priv_data, > >>>>> + struct mipi_dsi_device *device) > >>>>> +{ > >>>>> + struct meson_dw_mipi_dsi *mipi_dsi = priv_data; > >>>>> + > >>>>> + mipi_dsi->dsi_device = device; > >>>>> + > >>>>> + return 0; > >>>>> +} > >>>>> + > >>>>> +static int meson_dw_mipi_dsi_host_detach(void *priv_data, > >>>>> + struct mipi_dsi_device *device) > >>>>> +{ > >>>>> + struct meson_dw_mipi_dsi *mipi_dsi = priv_data; > >>>>> + > >>>>> + if (device == mipi_dsi->dsi_device) > >>>>> + mipi_dsi->dsi_device = NULL; > >>>>> + else > >>>>> + return -EINVAL; > >>>>> + > >>>>> + return 0; > >>>>> +} > >>>>> + > >>>>> +static const struct dw_mipi_dsi_host_ops meson_dw_mipi_dsi_host_ops = { > >>>>> + .attach = meson_dw_mipi_dsi_host_attach, > >>>>> + .detach = meson_dw_mipi_dsi_host_detach, > >>>>> +}; > >>>>> + > >>>>> +static int meson_dw_mipi_dsi_probe(struct platform_device *pdev) > >>>>> +{ > >>>>> + struct meson_dw_mipi_dsi *mipi_dsi; > >>>>> + struct reset_control *top_rst; > >>>>> + struct resource *res; > >>>>> + int ret; > >>>>> + > >>>>> + mipi_dsi = devm_kzalloc(&pdev->dev, sizeof(*mipi_dsi), GFP_KERNEL); > >>>>> + if (!mipi_dsi) > >>>>> + return -ENOMEM; > >>>>> + > >>>>> + mipi_dsi->dev = &pdev->dev; > >>>>> + > >>>>> + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); > >>>>> + mipi_dsi->base = devm_ioremap_resource(&pdev->dev, res); > >>>>> + if (IS_ERR(mipi_dsi->base)) > >>>>> + return PTR_ERR(mipi_dsi->base); > >>>>> + > >>>>> + mipi_dsi->phy = devm_phy_get(&pdev->dev, "dphy"); > >>>>> + if (IS_ERR(mipi_dsi->phy)) { > >>>>> + ret = PTR_ERR(mipi_dsi->phy); > >>>>> + dev_err(&pdev->dev, "failed to get mipi dphy: %d\n", ret); > >>>>> + return ret; > >>>>> + } > >>>>> + > >>>>> + mipi_dsi->px_clk = devm_clk_get(&pdev->dev, "px_clk"); > >>>>> + if (IS_ERR(mipi_dsi->px_clk)) { > >>>>> + dev_err(&pdev->dev, "Unable to get PLL clk\n"); > >>>>> + return PTR_ERR(mipi_dsi->px_clk); > >>>>> + } > >>>>> + > >>>>> + /* > >>>>> + * We use a TOP reset signal because the APB reset signal > >>>>> + * is handled by the TOP control registers. > >>>>> + */ > >>>>> + top_rst = devm_reset_control_get_exclusive(&pdev->dev, "top"); > >>>>> + if (IS_ERR(top_rst)) { > >>>>> + ret = PTR_ERR(top_rst); > >>>>> + > >>>>> + if (ret != -EPROBE_DEFER) > >>>>> + dev_err(&pdev->dev, "Unable to get reset control: %d\n", ret); > >>>>> + > >>>>> + return ret; > >>>>> + } > >>>>> + > >>>>> + ret = clk_prepare_enable(mipi_dsi->px_clk); > >>>>> + if (ret) { > >>>>> + dev_err(&pdev->dev, "Unable to prepare/enable PX clock\n"); > >>>>> + goto err_clkdisable; > >>>>> + } > >>>>> + > >>>>> + reset_control_assert(top_rst); > >>>>> + usleep_range(10, 20); > >>>>> + reset_control_deassert(top_rst); > >>>>> + > >>>>> + /* MIPI DSI Controller */ > >>>>> + > >>>>> + mipi_dsi->pdata.base = mipi_dsi->base; > >>>>> + mipi_dsi->pdata.max_data_lanes = 4; > >>>>> + mipi_dsi->pdata.phy_ops = &meson_dw_mipi_dsi_phy_ops; > >>>>> + mipi_dsi->pdata.host_ops = &meson_dw_mipi_dsi_host_ops; > >>>>> + mipi_dsi->pdata.priv_data = mipi_dsi; > >>>>> + platform_set_drvdata(pdev, mipi_dsi); > >>>>> + > >>>>> + mipi_dsi->dmd = dw_mipi_dsi_probe(pdev, &mipi_dsi->pdata); > >>>>> + if (IS_ERR(mipi_dsi->dmd)) { > >>>>> + ret = PTR_ERR(mipi_dsi->dmd); > >>>>> + if (ret != -EPROBE_DEFER) > >>>>> + dev_err(&pdev->dev, > >>>>> + "Failed to probe dw_mipi_dsi: %d\n", ret); > >>>>> + goto err_clkdisable; > >>>>> + } > >>>>> + > >>>>> + return component_add(mipi_dsi->dev, &meson_dw_mipi_dsi_ops); > >>>>> + > >>>>> +err_clkdisable: > >>>>> + clk_disable_unprepare(mipi_dsi->px_clk); > >>>>> + > >>>>> + return ret; > >>>>> +} > >>>>> + > >>>>> +static int meson_dw_mipi_dsi_remove(struct platform_device *pdev) > >>>>> +{ > >>>>> + struct meson_dw_mipi_dsi *mipi_dsi = dev_get_drvdata(&pdev->dev); > >>>>> + > >>>>> + component_del(mipi_dsi->dev, &meson_dw_mipi_dsi_ops); > >>>>> + > >>>>> + clk_disable_unprepare(mipi_dsi->px_clk); > >>>>> + > >>>>> + return 0; > >>>>> +} > >>>>> + > >>>>> +static const struct of_device_id meson_dw_mipi_dsi_of_table[] = { > >>>>> + { .compatible = "amlogic,meson-axg-dw-mipi-dsi", }, > >>>>> + { } > >>>>> +}; > >>>>> +MODULE_DEVICE_TABLE(of, meson_dw_mipi_dsi_of_table); > >>>>> + > >>>>> +static struct platform_driver meson_dw_mipi_dsi_platform_driver = { > >>>>> + .probe = meson_dw_mipi_dsi_probe, > >>>>> + .remove = meson_dw_mipi_dsi_remove, > >>>>> + .driver = { > >>>>> + .name = DRIVER_NAME, > >>>>> + .of_match_table = meson_dw_mipi_dsi_of_table, > >>>>> + }, > >>>>> +}; > >>>>> +module_platform_driver(meson_dw_mipi_dsi_platform_driver); > >>>>> + > >>>>> +MODULE_AUTHOR("Neil Armstrong <narmstrong@xxxxxxxxxxxx>"); > >>>>> +MODULE_DESCRIPTION(DRIVER_DESC); > >>>>> +MODULE_LICENSE("GPL"); > >>>>> -- > >>>>> 2.22.0 > >>>>> > >>>> > >>>> -- > >>>> Daniel Vetter > >>>> Software Engineer, Intel Corporation > >>>> http://blog.ffwll.ch > >>> > >> > >> _______________________________________________ > >> dri-devel mailing list > >> dri-devel@xxxxxxxxxxxxxxxxxxxxx > >> https://lists.freedesktop.org/mailman/listinfo/dri-devel > > > > _______________________________________________ > dri-devel mailing list > dri-devel@xxxxxxxxxxxxxxxxxxxxx > https://lists.freedesktop.org/mailman/listinfo/dri-devel -- Daniel Vetter Software Engineer, Intel Corporation http://blog.ffwll.ch _______________________________________________ dri-devel mailing list dri-devel@xxxxxxxxxxxxxxxxxxxxx https://lists.freedesktop.org/mailman/listinfo/dri-devel
