Received: by 2002:a25:1985:0:0:0:0:0 with SMTP id 127csp809974ybz; Wed, 22 Apr 2020 08:23:18 -0700 (PDT) X-Google-Smtp-Source: APiQypI1+7X1pFrYj0WMfsmXcwhBiSAw976SkzoWWlRwqKpAGbAu9rBV6dXi59bhV6pNLOrchnJd X-Received: by 2002:aa7:d653:: with SMTP id v19mr23054762edr.383.1587568998114; Wed, 22 Apr 2020 08:23:18 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1587568998; cv=none; d=google.com; s=arc-20160816; b=YDYV0oyGgZKzCdn1/fgerLtSfsS9vO+VYMBgYxZxGjLXCT6V6Z/wkugrAKjxjqGqPI t7Dbk6usMhICBHh7mkdTcHmXPcl9jKg1vi4r2Vg3D/sU23rBUDfzgOz2vY4pCI1kzzeU 8eksqEN+m11PZdea+QnFL8Qpj/cRKyoKH2y9hOtDcDdVWkVq2k48DHSy3RiTkqpoxjWy rtMe5O58gDVcuEm/5kO0TIaszH14enql+QRoqvd8d3dOxekYTqkAQB5NKgmI+6gFzvja t67qPJY5Zt0uMfIvdgW52AL8Ib6EXMVJbYRHe2m+nT25sWgbQ8NSMs4aGa+IxDwTPg++ 1p+g== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:sender:in-reply-to:content-disposition :mime-version:references:message-id:subject:cc:to:from:date :dkim-signature; bh=uHJJxVlfV/M4h110jJWf0QxbJtyIMrOI7QTOs+ybbX8=; b=RtuJ5bOLDGhFcLSBxgUrThxmEnKw4hz0P/X+xXKAimGoSzDt8Glgy8XG2cj6IfUyoa URfNhOqT3RZWtvHox3KgAyjyUk6xXfz17j7FS8OF4ENY3suXvKUg7gIpkEC0k9fvqahn +de13eR1WUmyIibppwmmf1AkNlqD09xdXexjw90Ik/5SHZzSox+g/Hb0MxGEohL2LylM XViJzmAeRmvNj6BsaMhcj/5KQbJHtAHB/x+UFxUQi9JqMR52HErr7KwyfY9m583cB9EA PeM6wairszgFzj7ypdm3yhhBc4wg8wjxDE00UhE3eFFqq6sT800jRWVAc7eucplcAh4C 54aA== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass (test mode) header.i=@ideasonboard.com header.s=mail header.b=ruFleYVN; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org Return-Path: Received: from vger.kernel.org (vger.kernel.org. [23.128.96.18]) by mx.google.com with ESMTP id g22si3874764ejr.228.2020.04.22.08.22.48; Wed, 22 Apr 2020 08:23:18 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) client-ip=23.128.96.18; Authentication-Results: mx.google.com; dkim=pass (test mode) header.i=@ideasonboard.com header.s=mail header.b=ruFleYVN; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1726385AbgDVPVK (ORCPT + 99 others); Wed, 22 Apr 2020 11:21:10 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:53776 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1725779AbgDVPVJ (ORCPT ); Wed, 22 Apr 2020 11:21:09 -0400 Received: from perceval.ideasonboard.com (perceval.ideasonboard.com [IPv6:2001:4b98:dc2:55:216:3eff:fef7:d647]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 6F100C03C1A9; Wed, 22 Apr 2020 08:21:08 -0700 (PDT) Received: from pendragon.ideasonboard.com (81-175-216-236.bb.dnainternet.fi [81.175.216.236]) by perceval.ideasonboard.com (Postfix) with ESMTPSA id 285AA528; Wed, 22 Apr 2020 17:21:04 +0200 (CEST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=ideasonboard.com; s=mail; t=1587568865; bh=lCa6artkL47nlcqm7UMlgsM9OWPEx1vZK1mgyajsP08=; h=Date:From:To:Cc:Subject:References:In-Reply-To:From; b=ruFleYVNzmYOixLvqUpwl2Nv/8h4BdFGfsWw6nEn0xWT+bgiOhM2DPm2h0wvAVnZc bGkbqF0wZOScf94xvYL2JM6fiAFNhX96NPopI2EBWcqzR+kDT9Kb4nbTN0RDuZ1Jjz P1W+8+Aegi9oVEQuqvUWYJVYExh9dpyxf/dOiokw= Date: Wed, 22 Apr 2020 18:20:50 +0300 From: Laurent Pinchart To: Adrian Ratiu Cc: linux-arm-kernel@lists.infradead.org, devicetree@vger.kernel.org, linux-rockchip@lists.infradead.org, Jernej Skrabec , Heiko Stuebner , Jonas Karlman , linux-kernel@vger.kernel.org, dri-devel@lists.freedesktop.org, Andrzej Hajda , kernel@collabora.com, linux-stm32@st-md-mailman.stormreply.com, linux-imx@nxp.com, Fabio Estevam , Enric Balletbo Serra , Emil Velikov , Adrian Pop , Arnaud Ferraris , Sjoerd Simons , Martyn Welch Subject: Re: [PATCH v7 4/8] drm: imx: Add i.MX 6 MIPI DSI host platform driver Message-ID: <20200422152050.GD28105@pendragon.ideasonboard.com> References: <20200421161610.1501827-1-adrian.ratiu@collabora.com> <20200421161610.1501827-5-adrian.ratiu@collabora.com> <20200422010727.GM5983@pendragon.ideasonboard.com> <87a733kgq1.fsf@collabora.com> MIME-Version: 1.0 Content-Type: text/plain; charset=utf-8 Content-Disposition: inline In-Reply-To: <87a733kgq1.fsf@collabora.com> Sender: linux-kernel-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Hi Adrian, On Wed, Apr 22, 2020 at 12:33:10PM +0300, Adrian Ratiu wrote: > On Wed, 22 Apr 2020, Laurent Pinchart wrote: > > On Tue, Apr 21, 2020 at 07:16:06PM +0300, Adrian Ratiu wrote: > >> This adds support for the Synopsis DesignWare MIPI DSI v1.01 > >> host controller which is embedded in i.MX 6 SoCs. Based on > >> following patches, but updated/extended to work with existing > >> support found in the kernel: - drm: imx: Support Synopsys > >> DesignWare MIPI DSI host controller > >> Signed-off-by: Liu Ying > >> Cc: Fabio Estevam Cc: Enric Balletbo > >> Serra Reviewed-by: Emil Velikov > >> Tested-by: Adrian Pop > >> Tested-by: Arnaud Ferraris > >> Signed-off-by: Sjoerd Simons > >> Signed-off-by: Martyn Welch > >> Signed-off-by: Adrian Ratiu > >> --- Changes since v6: > >> - Replaced custom noop encoder with the simple drm encoder > >> (Enric) - Added CONFIG_DRM_IMX6_MIPI_DSI depends on CONFIG_OF > >> (Enric) - Dropped imx_mipi_dsi_register() because now it only > >> creates the dummy encoder which can easily be done directly > >> in imx_dsi_bind() > >> Changes since v5: > >> - Reword to remove unrelated device tree patch mention > >> (Fabio) - Move pllref_clk enable/disable to bind/unbind > >> (Ezequiel) - Fix freescale.com -> nxp.com email addresses > >> (Fabio) - Also added myself as module author (Fabio) - Use > >> DRM_DEV_* macros for consistency, print more error msg > >> Changes since v4: > >> - Split off driver-specific configuration of phy timings due > >> to new upstream API. - Move regmap infrastructure logic to > >> separate commit (Ezequiel) - Move dsi v1.01 layout addition > >> to a separate commit (Ezequiel) - Minor warnings and driver > >> name fixes > >> Changes since v3: > >> - Renamed platform driver to reflect it's i.MX6 only. (Fabio) > >> Changes since v2: > >> - Fixed commit tags. (Emil) > >> Changes since v1: > >> - Moved register definitions & regmap initialization into > >> bridge module. Platform drivers get the regmap via plat_data > >> after calling the bridge probe. (Emil) > >> --- > >> drivers/gpu/drm/imx/Kconfig | 8 + > >> drivers/gpu/drm/imx/Makefile | 1 + > >> drivers/gpu/drm/imx/dw_mipi_dsi-imx6.c | 391 +++++++++++++++++++++++++ > >> 3 files changed, 400 insertions(+) > >> create mode 100644 drivers/gpu/drm/imx/dw_mipi_dsi-imx6.c > >> diff --git a/drivers/gpu/drm/imx/Kconfig b/drivers/gpu/drm/imx/Kconfig > >> index 207bf7409dfba..0dffc72df7922 100644 > >> --- a/drivers/gpu/drm/imx/Kconfig > >> +++ b/drivers/gpu/drm/imx/Kconfig > >> @@ -39,3 +39,11 @@ config DRM_IMX_HDMI > >> depends on DRM_IMX help Choose this if you want to use > >> HDMI on i.MX6. > >> + +config DRM_IMX6_MIPI_DSI + tristate "Freescale i.MX6 > >> DRM MIPI DSI" + select DRM_DW_MIPI_DSI + depends on > >> DRM_IMX + depends on OF + help + Choose this if you want > >> to use MIPI DSI on i.MX6. diff --git > >> a/drivers/gpu/drm/imx/Makefile b/drivers/gpu/drm/imx/Makefile > >> index 21cdcc2faabc8..9a7843c593478 100644 --- > >> a/drivers/gpu/drm/imx/Makefile +++ > >> b/drivers/gpu/drm/imx/Makefile @@ -9,3 +9,4 @@ > >> obj-$(CONFIG_DRM_IMX_TVE) += imx-tve.o > >> obj-$(CONFIG_DRM_IMX_LDB) += imx-ldb.o > >> obj-$(CONFIG_DRM_IMX_HDMI) += dw_hdmi-imx.o > >> +obj-$(CONFIG_DRM_IMX6_MIPI_DSI) += dw_mipi_dsi-imx6.o diff > >> --git a/drivers/gpu/drm/imx/dw_mipi_dsi-imx6.c > >> b/drivers/gpu/drm/imx/dw_mipi_dsi-imx6.c new file mode 100644 > >> index 0000000000000..f8a0a4fe16e21 --- /dev/null +++ > >> b/drivers/gpu/drm/imx/dw_mipi_dsi-imx6.c @@ -0,0 +1,391 @@ +// > >> SPDX-License-Identifier: GPL-2.0+ +/* + * i.MX6 drm driver - > >> MIPI DSI Host Controller + * + * Copyright (C) 2011-2015 > >> Freescale Semiconductor, Inc. + * Copyright (C) 2019-2020 > >> Collabora, Ltd. + */ + +#include +#include > >> +#include +#include > >> +#include > >> +#include +#include > >> +#include +#include > >> +#include > >> +#include +#include > >> +#include + +#include "imx-drm.h" + +#define > >> DSI_PWR_UP 0x04 +#define RESET > >> 0 +#define POWERUP BIT(0) + +#define > >> DSI_PHY_IF_CTRL 0x5c +#define > >> PHY_IF_CTRL_RESET 0x0 + +#define DSI_PHY_TST_CTRL0 > >> 0x64 +#define PHY_TESTCLK BIT(1) +#define > >> PHY_UNTESTCLK 0 +#define PHY_TESTCLR > >> BIT(0) +#define PHY_UNTESTCLR 0 + > >> +#define DSI_PHY_TST_CTRL1 0x68 +#define PHY_TESTEN > >> BIT(16) +#define PHY_UNTESTEN 0 +#define > >> PHY_TESTDOUT(n) (((n) & 0xff) << 8) > >> +#define PHY_TESTDIN(n) (((n) & 0xff) << > >> 0) + +struct imx_mipi_dsi { + struct drm_encoder > >> encoder; + struct device *dev; + struct regmap *mux_sel; + > >> struct dw_mipi_dsi *mipi_dsi; + struct clk *pllref_clk; + > >> + void __iomem *base; + unsigned int lane_mbps; +}; + > >> +struct dphy_pll_testdin_map { + unsigned int max_mbps; + > >> u8 testdin; +}; + +/* The table is based on 27MHz DPHY pll > >> reference clock. */ +static const struct dphy_pll_testdin_map > >> dptdin_map[] = { + {160, 0x04}, {180, 0x24}, {200, 0x44}, > >> {210, 0x06}, + {240, 0x26}, {250, 0x46}, {270, 0x08}, > >> {300, 0x28}, + {330, 0x48}, {360, 0x2a}, {400, 0x4a}, > >> {450, 0x0c}, + {500, 0x2c}, {550, 0x0e}, {600, 0x2e}, > >> {650, 0x10}, + {700, 0x30}, {750, 0x12}, {800, 0x32}, > >> {850, 0x14}, + {900, 0x34}, {950, 0x54}, {1000, 0x74} +}; > >> + +static inline struct imx_mipi_dsi *enc_to_dsi(struct > >> drm_encoder *enc) +{ + return container_of(enc, struct > >> imx_mipi_dsi, encoder); +} + +static void > >> imx_mipi_dsi_set_ipu_di_mux(struct imx_mipi_dsi *dsi, int > >> ipu_di) +{ + regmap_update_bits(dsi->mux_sel, IOMUXC_GPR3, + > >> IMX6Q_GPR3_MIPI_MUX_CTL_MASK, + ipu_di > >> << IMX6Q_GPR3_MIPI_MUX_CTL_SHIFT); +} + +static bool > >> imx_mipi_dsi_encoder_mode_fixup(struct drm_encoder *encoder, + > >> const struct drm_display_mode *mode, + > >> struct drm_display_mode *adj_mode) +{ + return true; +} + > >> +static int imx_mipi_dsi_encoder_atomic_check(struct > >> drm_encoder *encoder, + > >> struct drm_crtc_state *crtc_state, + > >> struct drm_connector_state *conn) +{ + struct > >> imx_crtc_state *imx_crtc_state = to_imx_crtc_state(crtc_state); > >> + + /* The following values are taken from > >> dw_hdmi_imx_atomic_check */ + imx_crtc_state->bus_format > >> = MEDIA_BUS_FMT_RGB888_1X24; + > >> imx_crtc_state->di_hsync_pin = 2; + > >> imx_crtc_state->di_vsync_pin = 3; + + return 0; +} > > > > No encoder functions please. This should be a bridge driver, the > > encoder should be created by the i.MX display controller driver > > itself. As that would require quite a bit of refactoring I'm OK > > having an encoder here for the meantime, but it should be a > > dummy one, without any operation. > > I am very grateful for your willingness to decrease the scope of > work required for this series, thank you, much appreciated! I'm sorry :-) I really wanted to make sure the end goal was expressed clearly. We won't reach it in one go, and I don't mind the precise direction of intermediate steps, as long as we get there eventually. > I'll make the "unify encoder creation" patch independent of this > series and use an empty encoder here. We can continue the bridge > refactoring discussion for the drivers in the other patch which > looks like it will become a series of its own :) > > >> + > >> +static void imx_mipi_dsi_encoder_commit(struct drm_encoder *encoder) > >> +{ > >> + struct imx_mipi_dsi *dsi = enc_to_dsi(encoder); > >> + int mux = drm_of_encoder_active_port_id(dsi->dev->of_node, encoder); > >> + > >> + imx_mipi_dsi_set_ipu_di_mux(dsi, mux); > >> +} > >> + > >> +static void imx_mipi_dsi_encoder_disable(struct drm_encoder *encoder) > >> +{ > >> +} > >> + > >> +static const struct drm_encoder_helper_funcs imx_mipi_dsi_encoder_helpers = { > >> + .mode_fixup = imx_mipi_dsi_encoder_mode_fixup, > >> + .commit = imx_mipi_dsi_encoder_commit, > >> + .disable = imx_mipi_dsi_encoder_disable, > >> + .atomic_check = imx_mipi_dsi_encoder_atomic_check, > >> +}; > >> + > >> +static enum drm_mode_status imx_mipi_dsi_mode_valid(void *priv_data, > >> + const struct drm_display_mode *mode) > >> +{ > >> + /* > >> + * The VID_PKT_SIZE field in the DSI_VID_PKT_CFG > >> + * register is 11-bit. > >> + */ > >> + if (mode->hdisplay > 0x7ff) > >> + return MODE_BAD_HVALUE; > >> + > >> + /* > >> + * The V_ACTIVE_LINES field in the DSI_VTIMING_CFG > >> + * register is 11-bit. > >> + */ > >> + if (mode->vdisplay > 0x7ff) > >> + return MODE_BAD_VVALUE; > >> + > >> + return MODE_OK; > >> +} > >> + > >> + > >> +static unsigned int max_mbps_to_testdin(unsigned int max_mbps) > >> +{ > >> + unsigned int i; > >> + > >> + for (i = 0; i < ARRAY_SIZE(dptdin_map); i++) > >> + if (dptdin_map[i].max_mbps == max_mbps) > >> + return dptdin_map[i].testdin; > >> + > >> + return -EINVAL; > >> +} > >> + > >> +static inline void dsi_write(struct imx_mipi_dsi *dsi, u32 reg, u32 val) > >> +{ > >> + writel(val, dsi->base + reg); > >> +} > >> + > >> +static int imx_mipi_dsi_phy_init(void *priv_data) > >> +{ > >> + struct imx_mipi_dsi *dsi = priv_data; > >> + int testdin; > >> + > >> + testdin = max_mbps_to_testdin(dsi->lane_mbps); > >> + if (testdin < 0) { > >> + DRM_DEV_ERROR(dsi->dev, > >> + "failed to get testdin for %dmbps lane clock\n", > >> + dsi->lane_mbps); > >> + return testdin; > >> + } > >> + > >> + dsi_write(dsi, DSI_PHY_IF_CTRL, PHY_IF_CTRL_RESET); > >> + dsi_write(dsi, DSI_PWR_UP, POWERUP); > >> + > >> + dsi_write(dsi, DSI_PHY_TST_CTRL0, PHY_UNTESTCLK | PHY_UNTESTCLR); > >> + dsi_write(dsi, DSI_PHY_TST_CTRL1, PHY_TESTEN | PHY_TESTDOUT(0) | > >> + PHY_TESTDIN(0x44)); > >> + dsi_write(dsi, DSI_PHY_TST_CTRL0, PHY_TESTCLK | PHY_UNTESTCLR); > >> + dsi_write(dsi, DSI_PHY_TST_CTRL0, PHY_UNTESTCLK | PHY_UNTESTCLR); > >> + dsi_write(dsi, DSI_PHY_TST_CTRL1, PHY_UNTESTEN | PHY_TESTDOUT(0) | > >> + PHY_TESTDIN(testdin)); > >> + dsi_write(dsi, DSI_PHY_TST_CTRL0, PHY_TESTCLK | PHY_UNTESTCLR); > >> + dsi_write(dsi, DSI_PHY_TST_CTRL0, PHY_UNTESTCLK | PHY_UNTESTCLR); > >> + > >> + return 0; > >> +} > >> + > >> +static int imx_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 imx_mipi_dsi *dsi = priv_data; > >> + int bpp; > >> + unsigned int i, target_mbps, mpclk; > >> + unsigned long pllref; > >> + > >> + bpp = mipi_dsi_pixel_format_to_bpp(format); > >> + if (bpp < 0) { > >> + DRM_DEV_ERROR(dsi->dev, "failed to get bpp for format %d: %d\n", > >> + format, bpp); > >> + return bpp; > >> + } > >> + > >> + pllref = clk_get_rate(dsi->pllref_clk); > >> + if (pllref != 27000000) > >> + DRM_WARN("DSI pllref_clk not set to 27Mhz\n"); > >> + > >> + mpclk = DIV_ROUND_UP(mode->clock, MSEC_PER_SEC); > >> + if (mpclk) { > >> + /* take 1/0.7 blanking overhead into consideration */ > >> + target_mbps = (mpclk * (bpp / lanes) * 10) / 7; > >> + } else { > >> + DRM_DEV_ERROR(dsi->dev, "use default 1Gbps DPHY pll clock\n"); > >> + target_mbps = 1000; > >> + } > >> + > >> + DRM_DEV_DEBUG(dsi->dev, "target pllref_clk frequency is %uMbps\n", > >> + target_mbps); > >> + > >> + for (i = 0; i < ARRAY_SIZE(dptdin_map); i++) { > >> + if (target_mbps < dptdin_map[i].max_mbps) { > >> + *lane_mbps = dptdin_map[i].max_mbps; > >> + dsi->lane_mbps = *lane_mbps; > >> + DRM_DEV_DEBUG(dsi->dev, > >> + "real pllref_clk frequency is %uMbps\n", > >> + *lane_mbps); > >> + return 0; > >> + } > >> + } > >> + > >> + DRM_DEV_ERROR(dsi->dev, "DPHY clock frequency %uMbps is out of range\n", > >> + target_mbps); > >> + > >> + return -EINVAL; > >> +} > >> + > >> +static int > >> +dw_mipi_dsi_phy_get_timing(void *priv_data, unsigned int lane_mbps, > >> + struct dw_mipi_dsi_dphy_timing *timing) > >> +{ > >> + timing->clk_hs2lp = 0x40; > >> + timing->clk_lp2hs = 0x40; > >> + timing->data_hs2lp = 0x40; > >> + timing->data_lp2hs = 0x40; > >> + > >> + return 0; > >> +} > >> + > >> +static const struct dw_mipi_dsi_phy_ops dw_mipi_dsi_imx6_phy_ops = { > >> + .init = imx_mipi_dsi_phy_init, > >> + .get_lane_mbps = imx_mipi_dsi_get_lane_mbps, > >> + .get_timing = dw_mipi_dsi_phy_get_timing, > >> +}; > >> + > >> +static struct dw_mipi_dsi_plat_data imx6q_mipi_dsi_drv_data = { > >> + .max_data_lanes = 2, > >> + .mode_valid = imx_mipi_dsi_mode_valid, > >> + .phy_ops = &dw_mipi_dsi_imx6_phy_ops, > >> +}; > >> + > >> +static const struct of_device_id imx_dsi_dt_ids[] = { > >> + { > >> + .compatible = "fsl,imx6q-mipi-dsi", > >> + .data = &imx6q_mipi_dsi_drv_data, > >> + }, > >> + { /* sentinel */ } > >> +}; > >> +MODULE_DEVICE_TABLE(of, imx_dsi_dt_ids); > >> + > >> +static int imx_mipi_dsi_bind(struct device *dev, struct device *master, > >> + void *data) > >> +{ > >> + struct imx_mipi_dsi *dsi = dev_get_drvdata(dev); > >> + struct drm_device *drm = data; > >> + int ret; > >> + > >> + ret = clk_prepare_enable(dsi->pllref_clk); > >> + if (ret) { > >> + DRM_DEV_ERROR(dev, "Failed to enable pllref_clk: %d\n", ret); > >> + return ret; > >> + } > >> + > >> + ret = imx_drm_create_encoder(drm, &dsi->encoder, dsi->dev->of_node); > >> + if (ret) { > >> + DRM_DEV_ERROR(dsi->dev, "failed to create drm encoder\n"); > >> + return ret; > >> + } > >> + > >> + drm_encoder_helper_add(&dsi->encoder, &imx_mipi_dsi_encoder_helpers); > >> + > >> + ret = dw_mipi_dsi_bind(dsi->mipi_dsi, &dsi->encoder); > >> + if (ret) { > >> + DRM_DEV_ERROR(dev, "Failed to bind: %d\n", ret); > >> + return ret; > >> + } > >> + > >> + return 0; > >> +} > >> + > >> +static void imx_mipi_dsi_unbind(struct device *dev, struct device *master, > >> + void *data) > >> +{ > >> + struct imx_mipi_dsi *dsi = dev_get_drvdata(dev); > >> + > >> + dw_mipi_dsi_unbind(dsi->mipi_dsi); > >> + > >> + clk_disable_unprepare(dsi->pllref_clk); > >> +} > >> + > >> +static const struct component_ops imx_mipi_dsi_ops = { > >> + .bind = imx_mipi_dsi_bind, > >> + .unbind = imx_mipi_dsi_unbind, > >> +}; > >> + > >> +static int imx_mipi_dsi_probe(struct platform_device *pdev) > >> +{ > >> + struct device *dev = &pdev->dev; > >> + const struct of_device_id *of_id = of_match_device(imx_dsi_dt_ids, dev); > >> + struct dw_mipi_dsi_plat_data *pdata = (struct dw_mipi_dsi_plat_data *) of_id->data; > >> + struct imx_mipi_dsi *dsi; > >> + struct resource *res; > >> + int ret; > >> + > >> + dsi = devm_kzalloc(dev, sizeof(*dsi), GFP_KERNEL); > >> + if (!dsi) > >> + return -ENOMEM; > >> + > >> + dsi->dev = dev; > >> + > >> + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); > >> + dsi->base = devm_ioremap_resource(dev, res); > >> + if (IS_ERR(dsi->base)) { > >> + ret = PTR_ERR(dsi->base); > >> + DRM_DEV_ERROR(dev, "Unable to get dsi registers: %d\n", ret); > >> + return ret; > >> + } > >> + > >> + dsi->pllref_clk = devm_clk_get(dev, "ref"); > >> + if (IS_ERR(dsi->pllref_clk)) { > >> + ret = PTR_ERR(dsi->pllref_clk); > >> + DRM_DEV_ERROR(dev, "Unable to get pllref_clk: %d\n", ret); > >> + return ret; > >> + } > >> + > >> + dsi->mux_sel = syscon_regmap_lookup_by_phandle(dev->of_node, "fsl,gpr"); > >> + if (IS_ERR(dsi->mux_sel)) { > >> + ret = PTR_ERR(dsi->mux_sel); > >> + DRM_DEV_ERROR(dev, "Failed to get GPR regmap: %d\n", ret); > >> + return ret; > >> + } > >> + > >> + dev_set_drvdata(dev, dsi); > >> + > >> + imx6q_mipi_dsi_drv_data.base = dsi->base; > >> + imx6q_mipi_dsi_drv_data.priv_data = dsi; > >> + > >> + dsi->mipi_dsi = dw_mipi_dsi_probe(pdev, pdata); > >> + if (IS_ERR(dsi->mipi_dsi)) { > >> + ret = PTR_ERR(dsi->mipi_dsi); > >> + DRM_DEV_ERROR(dev, "Failed to probe DW DSI host: %d\n", ret); > >> + goto err_clkdisable; > >> + } > >> + > >> + return component_add(&pdev->dev, &imx_mipi_dsi_ops); > >> + > >> +err_clkdisable: > >> + clk_disable_unprepare(dsi->pllref_clk); > >> + return ret; > >> +} > >> + > >> +static int imx_mipi_dsi_remove(struct platform_device *pdev) > >> +{ > >> + component_del(&pdev->dev, &imx_mipi_dsi_ops); > >> + return 0; > >> +} > >> + > >> +static struct platform_driver imx_mipi_dsi_driver = { > >> + .probe = imx_mipi_dsi_probe, > >> + .remove = imx_mipi_dsi_remove, > >> + .driver = { > >> + .of_match_table = imx_dsi_dt_ids, > >> + .name = "dw-mipi-dsi-imx6", > >> + }, > >> +}; > >> +module_platform_driver(imx_mipi_dsi_driver); > >> + > >> +MODULE_DESCRIPTION("i.MX6 MIPI DSI host controller driver"); > >> +MODULE_AUTHOR("Liu Ying "); > >> +MODULE_AUTHOR("Adrian Ratiu "); > >> +MODULE_LICENSE("GPL"); -- Regards, Laurent Pinchart