From mboxrd@z Thu Jan  1 00:00:00 1970
Return-Path: <SRS0=IdmP=CQ=lists.infradead.org=linux-amlogic-bounces+linux-amlogic=archiver.kernel.org@kernel.org>
X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on
	aws-us-west-2-korg-lkml-1.web.codeaurora.org
X-Spam-Level: 
X-Spam-Status: No, score=-9.8 required=3.0 tests=BAYES_00,DKIMWL_WL_HIGH,
	DKIM_SIGNED,DKIM_VALID,HEADER_FROM_DIFFERENT_DOMAINS,INCLUDES_PATCH,
	MAILING_LIST_MULTI,SIGNED_OFF_BY,SPF_HELO_NONE,SPF_PASS,URIBL_BLOCKED
	autolearn=unavailable autolearn_force=no version=3.4.0
Received: from mail.kernel.org (mail.kernel.org [198.145.29.99])
	by smtp.lore.kernel.org (Postfix) with ESMTP id 0FBECC43461
	for <linux-amlogic@archiver.kernel.org>; Mon,  7 Sep 2020 08:44:34 +0000 (UTC)
Received: from merlin.infradead.org (merlin.infradead.org [205.233.59.134])
	(using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits))
	(No client certificate requested)
	by mail.kernel.org (Postfix) with ESMTPS id 8C4B62145D
	for <linux-amlogic@archiver.kernel.org>; Mon,  7 Sep 2020 08:44:33 +0000 (UTC)
Authentication-Results: mail.kernel.org;
	dkim=pass (2048-bit key) header.d=lists.infradead.org header.i=@lists.infradead.org header.b="uxSl1OsS";
	dkim=fail reason="signature verification failed" (1024-bit key) header.d=ffwll.ch header.i=@ffwll.ch header.b="Sekv5nMW"
DMARC-Filter: OpenDMARC Filter v1.3.2 mail.kernel.org 8C4B62145D
Authentication-Results: mail.kernel.org; dmarc=none (p=none dis=none) header.from=ffwll.ch
Authentication-Results: mail.kernel.org; spf=none smtp.mailfrom=linux-amlogic-bounces+linux-amlogic=archiver.kernel.org@lists.infradead.org
DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed;
	d=lists.infradead.org; s=merlin.20170209; h=Sender:Content-Transfer-Encoding:
	Content-Type:List-Subscribe:List-Help:List-Post:List-Archive:List-Unsubscribe
	:List-Id:In-Reply-To:MIME-Version:References:Message-ID:Subject:To:From:Date:
	Reply-To:Cc:Content-ID:Content-Description:Resent-Date:Resent-From:
	Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner;
	bh=pjW15kQJxREpIdDj/njB8O/94apAvnC0A/yoWGe0WYE=; b=uxSl1OsSmzQypxohu9htNuQ5KY
	jwfH58klniyIz0OvwB4LQ8OpukN8WNAy/I386obcKGlL/fVdq3UrW1KadyGlpHxgwZUkIfa/Y+4Mv
	HVZKm0FGC5WU+Wny9clCtiIyO+OARee9pPKNClQhlRlTwQGLOR8uecyCZ3E6/VXquppnC4JU0SJVC
	6O0AFo7F/u9zcugy0jaAxgkg+ln9HeWnWi+196yq1QpgJnGDbpXKxcN9y7Fn9fg5vWixciilV+Ypu
	c8dr7LQHQ61EDVSFOhCvT11HsAHPKmNsRDpHPcsQX9T93YlvhhqprDiRwT0oMNx7i0KHBQn1+BTr9
	wc/M6n6Q==;
Received: from localhost ([::1] helo=merlin.infradead.org)
	by merlin.infradead.org with esmtp (Exim 4.92.3 #3 (Red Hat Linux))
	id 1kFClJ-0006az-D7; Mon, 07 Sep 2020 08:44:29 +0000
Received: from mail-wr1-x441.google.com ([2a00:1450:4864:20::441])
 by merlin.infradead.org with esmtps (Exim 4.92.3 #3 (Red Hat Linux))
 id 1kFClG-0006Zk-LG
 for linux-amlogic@lists.infradead.org; Mon, 07 Sep 2020 08:44:27 +0000
Received: by mail-wr1-x441.google.com with SMTP id k15so14839674wrn.10
 for <linux-amlogic@lists.infradead.org>; Mon, 07 Sep 2020 01:44:26 -0700 (PDT)
DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=ffwll.ch; s=google;
 h=date:from:to:subject:message-id:mail-followup-to:references
 :mime-version:content-disposition:in-reply-to;
 bh=vCnAWdnxSr/38fyjTvOTRJxFVAmm6+c6MV2keTsd7MA=;
 b=Sekv5nMWTfXrdvtBSBt4tq0Y2AbxKBQri2AcmRiNB1b/6QkAYONgRhWwL6adv1U9Oy
 OX2jj3wgvrHe6JSVMMdbyFzCJHoLonklvzeVS7ggDhRinAxScsdt2RO/p8UzCg+atNG2
 DdmRTImKPguTHk+r/2WmdHazQCI/qe2UrdAT8=
X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed;
 d=1e100.net; s=20161025;
 h=x-gm-message-state:date:from:to:subject:message-id:mail-followup-to
 :references:mime-version:content-disposition:in-reply-to;
 bh=vCnAWdnxSr/38fyjTvOTRJxFVAmm6+c6MV2keTsd7MA=;
 b=qrpgGO5QAoTY0uiMYp6TPeTF6VcyEcoKFIVpIsQsIdInc/y86thRovy+Wlba1ODlXb
 moTC9/bRNKKnhCcyYSBfFgtuN9i2iqNelwGqA/pXros5pRgvphJDtBNjNpzuCn60jlxF
 nD2zqbXwzIDj9P0b/cZaPikY0osDmRDd4oa4Oezh/z8Tk/YSIMjFchNYf5r0jkBJXjnj
 KKG5V1so9qfhgnwradUUUrEP7t3ttNlACAY/woOTMUr7sd2dX1/einRGoONZQpe6zE4g
 40pX82IgOoERqFjjr5tSG8pRoRpLEgDyLIQfaR1+/yngM/7wXzGSqb8ZQGbiu/oC5j2b
 dgsw==
X-Gm-Message-State: AOAM530hTFvA/Q4LRdBKj6wEwTSBkHu3Nal2AO0UWVdCjFRd0z5VCumF
 1hKNACrdtve9QXNM//46Khoy+8fY8gWuxSIb
X-Google-Smtp-Source: ABdhPJxo0b2BioN6yS6K8NDFZRYtT7Z/wlisahbg3vMF0PpzK5nxYaIuo/QXZEQcvDOG3slBf4Dj+A==
X-Received: by 2002:a5d:660f:: with SMTP id n15mr15531018wru.103.1599468265492; 
 Mon, 07 Sep 2020 01:44:25 -0700 (PDT)
Received: from phenom.ffwll.local ([2a02:168:57f4:0:efd0:b9e5:5ae6:c2fa])
 by smtp.gmail.com with ESMTPSA id z19sm6776901wmi.3.2020.09.07.01.44.24
 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256);
 Mon, 07 Sep 2020 01:44:24 -0700 (PDT)
Date: Mon, 7 Sep 2020 10:44:23 +0200
From: Daniel Vetter <daniel@ffwll.ch>
To: Neil Armstrong <narmstrong@baylibre.com>,
 dri-devel@lists.freedesktop.org, linux-amlogic@lists.infradead.org,
 linux-kernel@vger.kernel.org
Subject: Re: [PATCH 6/6] drm/meson: add support for MIPI-DSI transceiver
Message-ID: <20200907084423.GW2352366@phenom.ffwll.local>
Mail-Followup-To: Neil Armstrong <narmstrong@baylibre.com>,
 dri-devel@lists.freedesktop.org, linux-amlogic@lists.infradead.org,
 linux-kernel@vger.kernel.org
References: <20200907081825.1654-1-narmstrong@baylibre.com>
 <20200907081825.1654-7-narmstrong@baylibre.com>
 <20200907084351.GV2352366@phenom.ffwll.local>
MIME-Version: 1.0
Content-Disposition: inline
In-Reply-To: <20200907084351.GV2352366@phenom.ffwll.local>
X-Operating-System: Linux phenom 5.7.0-1-amd64 
X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 
X-CRM114-CacheID: sfid-20200907_044426_698450_843D082E 
X-CRM114-Status: GOOD (  35.07  )
X-BeenThere: linux-amlogic@lists.infradead.org
X-Mailman-Version: 2.1.29
Precedence: list
List-Id: <linux-amlogic.lists.infradead.org>
List-Unsubscribe: <http://lists.infradead.org/mailman/options/linux-amlogic>, 
 <mailto:linux-amlogic-request@lists.infradead.org?subject=unsubscribe>
List-Archive: <http://lists.infradead.org/pipermail/linux-amlogic/>
List-Post: <mailto:linux-amlogic@lists.infradead.org>
List-Help: <mailto:linux-amlogic-request@lists.infradead.org?subject=help>
List-Subscribe: <http://lists.infradead.org/mailman/listinfo/linux-amlogic>,
 <mailto:linux-amlogic-request@lists.infradead.org?subject=subscribe>
Content-Type: text/plain; charset="us-ascii"
Content-Transfer-Encoding: 7bit
Sender: "linux-amlogic" <linux-amlogic-bounces@lists.infradead.org>
Errors-To: linux-amlogic-bounces+linux-amlogic=archiver.kernel.org@lists.infradead.org

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@baylibre.com>
> 
> 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
...

> 
> 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@baylibre.com>
> > + * 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@baylibre.com>");
> > +MODULE_DESCRIPTION(DRIVER_DESC);
> > +MODULE_LICENSE("GPL");
> > -- 
> > 2.22.0
> > 
> 
> -- 
> Daniel Vetter
> Software Engineer, Intel Corporation
> http://blog.ffwll.ch

-- 
Daniel Vetter
Software Engineer, Intel Corporation
http://blog.ffwll.ch

_______________________________________________
linux-amlogic mailing list
linux-amlogic@lists.infradead.org
http://lists.infradead.org/mailman/listinfo/linux-amlogic