Re: [PATCH 2/2] drm/mcde: Support DPI output

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



Hi Linus.

On Thu, Nov 12, 2020 at 03:29:25PM +0100, Linus Walleij wrote:
> This implements support for DPI output using the port node
> in the device tree to connect a DPI LCD display to the
> MCDE. The block also supports TV-out but we leave that
> for another day when we have a hardware using it.
> 
> We implement parsing and handling of the "port" node,
> and follow that to the DPI endpoint.
> 
> The clock divider used by the MCDE to divide down the
> "lcdclk" (this has been designed for TV-like frequencies)
> is represented by an ordinary clock provider internally
> in the MCDE. This idea was inspired by the PL111 solution
> by Eric Anholt: the divider also works very similar to
> the Pl111 clock divider.
> 
> We take care to clear up some errors regarding the number
> of available formatters and their type. We have 6 DSI
> formatters and 2 DPI formatters.
> 
> Tested on the Samsung GT-I9070 Janice mobile phone.
> 
> Cc: Stephan Gerhold <stephan@xxxxxxxxxxx>
> Cc: phone-devel@xxxxxxxxxxxxxxx
> Cc: upstreaming@xxxxxxxxxxx
> Signed-off-by: Linus Walleij <linus.walleij@xxxxxxxxxx>
> ---
>  drivers/gpu/drm/mcde/Kconfig             |   1 +
>  drivers/gpu/drm/mcde/Makefile            |   2 +-
>  drivers/gpu/drm/mcde/mcde_clk_div.c      | 192 ++++++++++++++
>  drivers/gpu/drm/mcde/mcde_display.c      | 304 ++++++++++++++++++++---
>  drivers/gpu/drm/mcde/mcde_display_regs.h |  87 +++++++
>  drivers/gpu/drm/mcde/mcde_drm.h          |  10 +
>  drivers/gpu/drm/mcde/mcde_drv.c          |  46 +++-
>  7 files changed, 595 insertions(+), 47 deletions(-)
>  create mode 100644 drivers/gpu/drm/mcde/mcde_clk_div.c
> 
> diff --git a/drivers/gpu/drm/mcde/Kconfig b/drivers/gpu/drm/mcde/Kconfig
> index b3990126562c..71c689b573c9 100644
> --- a/drivers/gpu/drm/mcde/Kconfig
> +++ b/drivers/gpu/drm/mcde/Kconfig
> @@ -4,6 +4,7 @@ config DRM_MCDE
>  	depends on CMA
>  	depends on ARM || COMPILE_TEST
>  	depends on OF
> +	depends on COMMON_CLK
>  	select MFD_SYSCON
>  	select DRM_MIPI_DSI
>  	select DRM_BRIDGE
> diff --git a/drivers/gpu/drm/mcde/Makefile b/drivers/gpu/drm/mcde/Makefile
> index fe28f4e0fe46..15d9c89a3273 100644
> --- a/drivers/gpu/drm/mcde/Makefile
> +++ b/drivers/gpu/drm/mcde/Makefile
> @@ -1,3 +1,3 @@
> -mcde_drm-y +=	mcde_drv.o mcde_dsi.o mcde_display.o
> +mcde_drm-y +=	mcde_drv.o mcde_dsi.o mcde_clk_div.o mcde_display.o
>  
>  obj-$(CONFIG_DRM_MCDE) += mcde_drm.o
> diff --git a/drivers/gpu/drm/mcde/mcde_clk_div.c b/drivers/gpu/drm/mcde/mcde_clk_div.c
> new file mode 100644
> index 000000000000..038821d2ef80
> --- /dev/null
> +++ b/drivers/gpu/drm/mcde/mcde_clk_div.c
> @@ -0,0 +1,192 @@
> +// SPDX-License-Identifier: GPL-2.0
> +#include <linux/clk-provider.h>
> +#include <linux/regulator/consumer.h>
> +
> +#include "mcde_drm.h"
> +#include "mcde_display_regs.h"
> +
> +/* The MCDE internal clock dividers for FIFO A and B */
> +struct mcde_clk_div {
> +	struct clk_hw hw;
> +	struct mcde *mcde;
> +	u32 cr;
> +	u32 cr_div;
> +};
> +
> +static int mcde_clk_div_enable(struct clk_hw *hw)
> +{
> +	struct mcde_clk_div *cdiv = container_of(hw, struct mcde_clk_div, hw);
> +	struct mcde *mcde = cdiv->mcde;
> +	u32 val;
> +
> +	spin_lock(&mcde->fifo_crx1_lock);
> +	val = readl(mcde->regs + cdiv->cr);
> +	/*
> +	 * Select the PLL72 (LCD) clock as parent
> +	 * FIXME: implement other parents.
> +	 */
> +	val &= ~MCDE_CRX1_CLKSEL_MASK;
> +	val |= MCDE_CRX1_CLKSEL_CLKPLL72 << MCDE_CRX1_CLKSEL_SHIFT;
> +	/* Internal clock */
> +	val |= MCDE_CRA1_CLKTYPE_TVXCLKSEL1;
> +
> +	/* Clear then set the divider */
> +	val &= ~(MCDE_CRX1_BCD | MCDE_CRX1_PCD_MASK);
> +	val |= cdiv->cr_div;
> +
> +	writel(val, mcde->regs + cdiv->cr);
> +	spin_unlock(&mcde->fifo_crx1_lock);
> +
> +	return 0;
> +}
> +
> +static int mcde_clk_div_choose_div(struct clk_hw *hw, unsigned long rate,
> +				   unsigned long *prate, bool set_parent)
> +{
> +	int best_div = 1, div;
> +	struct clk_hw *parent = clk_hw_get_parent(hw);
> +	unsigned long best_prate = 0;
> +	unsigned long best_diff = ~0ul;
> +	int max_div = (1 << MCDE_CRX1_PCD_BITS) - 1;
> +
> +	for (div = 1; div < max_div; div++) {
> +		unsigned long this_prate, div_rate, diff;
> +
> +		if (set_parent)
> +			this_prate = clk_hw_round_rate(parent, rate * div);
> +		else
> +			this_prate = *prate;
> +		div_rate = DIV_ROUND_UP_ULL(this_prate, div);
> +		diff = abs(rate - div_rate);
> +
> +		if (diff < best_diff) {
> +			best_div = div;
> +			best_diff = diff;
> +			best_prate = this_prate;
> +		}
> +	}
> +
> +	*prate = best_prate;
> +	return best_div;
> +}
> +
> +static long mcde_clk_div_round_rate(struct clk_hw *hw, unsigned long rate,
> +				     unsigned long *prate)
> +{
> +	int div = mcde_clk_div_choose_div(hw, rate, prate, true);
> +
> +	return DIV_ROUND_UP_ULL(*prate, div);
> +}
> +
> +static unsigned long mcde_clk_div_recalc_rate(struct clk_hw *hw,
> +					       unsigned long prate)
> +{
> +	struct mcde_clk_div *cdiv = container_of(hw, struct mcde_clk_div, hw);
> +	struct mcde *mcde = cdiv->mcde;
> +	u32 cr;
> +	int div;
> +
> +	/*
> +	 * If the MCDE is not powered we can't access registers.
> +	 * It will come up with 0 in the divider register bits, which
> +	 * means "divide by 2".
> +	 */
> +	if (!regulator_is_enabled(mcde->epod))
> +		return DIV_ROUND_UP_ULL(prate, 2);
> +
> +	cr = readl(mcde->regs + cdiv->cr);
> +	if (cr & MCDE_CRX1_BCD)
> +		return prate;
> +
> +	/* 0 in the PCD means "divide by 2", 1 means "divide by 3" etc */
> +	div = cr & MCDE_CRX1_PCD_MASK;
> +	div += 2;
> +
> +	return DIV_ROUND_UP_ULL(prate, div);
> +}
> +
> +static int mcde_clk_div_set_rate(struct clk_hw *hw, unsigned long rate,
> +				  unsigned long prate)
> +{
> +	struct mcde_clk_div *cdiv = container_of(hw, struct mcde_clk_div, hw);
> +	int div = mcde_clk_div_choose_div(hw, rate, &prate, false);
> +	u32 cr = 0;
> +
> +	/*
> +	 * We cache the CR bits to set the divide in the state so that
> +	 * we can call this before we can even write to the hardware.
> +	 */
> +	if (div == 1) {
> +		/* Bypass clock divider */
> +		cr |= MCDE_CRX1_BCD;
> +	} else {
> +		div -= 2;
> +		cr |= div & MCDE_CRX1_PCD_MASK;
> +	}
> +	cdiv->cr_div = cr;
> +
> +	return 0;
> +}
> +
> +static const struct clk_ops mcde_clk_div_ops = {
> +	.enable = mcde_clk_div_enable,
> +	.recalc_rate = mcde_clk_div_recalc_rate,
> +	.round_rate = mcde_clk_div_round_rate,
> +	.set_rate = mcde_clk_div_set_rate,
> +};
> +
> +int mcde_init_clock_divider(struct mcde *mcde)
> +{
> +	struct device *dev = mcde->dev;
> +	struct mcde_clk_div *fifoa;
> +	struct mcde_clk_div *fifob;
> +	const char *parent_name;
> +	struct clk_init_data fifoa_init = {
const?

> +		.name = "fifoa",
> +		.ops = &mcde_clk_div_ops,
> +		.parent_names = &parent_name,
> +		.num_parents = 1,
> +		.flags = CLK_SET_RATE_PARENT,
> +	};
> +	struct clk_init_data fifob_init = {
const?

> +		.name = "fifob",
> +		.ops = &mcde_clk_div_ops,
> +		.parent_names = &parent_name,
> +		.num_parents = 1,
> +		.flags = CLK_SET_RATE_PARENT,
> +	};
> +	int ret;
> +
> +	spin_lock_init(&mcde->fifo_crx1_lock);
> +	parent_name = __clk_get_name(mcde->lcd_clk);
> +
> +	/* Allocate 2 clocks */
> +	fifoa = devm_kzalloc(dev, sizeof(*fifoa), GFP_KERNEL);
> +	if (!fifoa)
> +		return -ENOMEM;
> +	fifob = devm_kzalloc(dev, sizeof(*fifob), GFP_KERNEL);
> +	if (!fifob)
> +		return -ENOMEM;
> +
> +	fifoa->mcde = mcde;
> +	fifoa->cr = MCDE_CRA1;
> +	fifoa->hw.init = &fifoa_init;
> +	ret = devm_clk_hw_register(dev, &fifoa->hw);
> +	if (ret) {
> +		dev_err(dev, "error registering FIFO A clock divider\n");
> +		return ret;
> +	}
> +	mcde->fifoa_clk = fifoa->hw.clk;
> +
> +	fifob->mcde = mcde;
> +	fifob->cr = MCDE_CRB1;
> +	fifob->hw.init = &fifob_init;
> +	ret = devm_clk_hw_register(dev, &fifob->hw);
> +	if (ret) {
> +		dev_err(dev, "error registering FIFO B clock divider\n");
> +		return ret;
> +	}
> +	mcde->fifob_clk = fifob->hw.clk;
> +
> +	return 0;
> +}
> diff --git a/drivers/gpu/drm/mcde/mcde_display.c b/drivers/gpu/drm/mcde/mcde_display.c
> index 66a07e340f8a..14c76d3a8e5a 100644
> --- a/drivers/gpu/drm/mcde/mcde_display.c
> +++ b/drivers/gpu/drm/mcde/mcde_display.c
> @@ -8,6 +8,7 @@
>  #include <linux/delay.h>
>  #include <linux/dma-buf.h>
>  #include <linux/regulator/consumer.h>
> +#include <linux/media-bus-format.h>
>  
>  #include <drm/drm_device.h>
>  #include <drm/drm_fb_cma_helper.h>
> @@ -16,6 +17,7 @@
>  #include <drm/drm_gem_framebuffer_helper.h>
>  #include <drm/drm_mipi_dsi.h>
>  #include <drm/drm_simple_kms_helper.h>
> +#include <drm/drm_bridge.h>
>  #include <drm/drm_vblank.h>
>  #include <video/mipi_display.h>
>  
> @@ -57,10 +59,15 @@ enum mcde_overlay {
>  	MCDE_OVERLAY_5,
>  };
>  
> -enum mcde_dsi_formatter {
> +enum mcde_formatter {
>  	MCDE_DSI_FORMATTER_0 = 0,
>  	MCDE_DSI_FORMATTER_1,
>  	MCDE_DSI_FORMATTER_2,
> +	MCDE_DSI_FORMATTER_3,
> +	MCDE_DSI_FORMATTER_4,
> +	MCDE_DSI_FORMATTER_5,
> +	MCDE_DPI_FORMATTER_0,
> +	MCDE_DPI_FORMATTER_1,
>  };
>  
>  void mcde_display_irq(struct mcde *mcde)
> @@ -81,7 +88,7 @@ void mcde_display_irq(struct mcde *mcde)
>  	 *
>  	 * TODO: Currently only one DSI link is supported.
>  	 */
> -	if (mcde_dsi_irq(mcde->mdsi)) {
> +	if (!mcde->dpi_output && mcde_dsi_irq(mcde->mdsi)) {
>  		u32 val;
>  
>  		/*
> @@ -556,6 +563,7 @@ static void mcde_configure_channel(struct mcde *mcde, enum mcde_channel ch,
>  			<< MCDE_CHNLXSYNCHMOD_OUT_SYNCH_SRC_SHIFT;
>  		break;
>  	case MCDE_VIDEO_FORMATTER_FLOW:
> +	case MCDE_DPI_FORMATTER_FLOW:
>  		val = MCDE_CHNLXSYNCHMOD_SRC_SYNCH_HARDWARE
>  			<< MCDE_CHNLXSYNCHMOD_SRC_SYNCH_SHIFT;
>  		val |= MCDE_CHNLXSYNCHMOD_OUT_SYNCH_SRC_FORMATTER
> @@ -594,10 +602,35 @@ static void mcde_configure_channel(struct mcde *mcde, enum mcde_channel ch,
>  		       mcde->regs + mux);
>  		break;
>  	}
> +
> +	/*
> +	 * If using DPI configure the sync event.
> +	 * TODO: this is for LCD only, it does not cover TV out.
> +	 */
> +	if (mcde->dpi_output) {
> +		u32 stripwidth;
> +
> +		stripwidth = 0xF000 / (mode->vdisplay * 4);
> +		dev_info(mcde->dev, "stripwidth: %d\n", stripwidth);
> +
> +		val = MCDE_SYNCHCONF_HWREQVEVENT_ACTIVE_VIDEO |
> +			(mode->hdisplay - 1 - stripwidth) << MCDE_SYNCHCONF_HWREQVCNT_SHIFT |
> +			MCDE_SYNCHCONF_SWINTVEVENT_ACTIVE_VIDEO |
> +			(mode->hdisplay - 1 - stripwidth) << MCDE_SYNCHCONF_SWINTVCNT_SHIFT;
> +
> +		switch (fifo) {
> +		case MCDE_FIFO_A:
> +			writel(val, mcde->regs + MCDE_SYNCHCONFA);
> +			break;
> +		case MCDE_FIFO_B:
> +			writel(val, mcde->regs + MCDE_SYNCHCONFB);
> +			break;
> +		}
> +	}
>  }
>  
>  static void mcde_configure_fifo(struct mcde *mcde, enum mcde_fifo fifo,
> -				enum mcde_dsi_formatter fmt,
> +				enum mcde_formatter fmt,
>  				int fifo_wtrmrk)
>  {
>  	u32 val;
> @@ -618,12 +651,49 @@ static void mcde_configure_fifo(struct mcde *mcde, enum mcde_fifo fifo,
>  	}
>  
>  	val = fifo_wtrmrk << MCDE_CTRLX_FIFOWTRMRK_SHIFT;
> -	/* We only support DSI formatting for now */
> -	val |= MCDE_CTRLX_FORMTYPE_DSI <<
> -		MCDE_CTRLX_FORMTYPE_SHIFT;
>  
> -	/* Select the formatter to use for this FIFO */
> -	val |= fmt << MCDE_CTRLX_FORMID_SHIFT;
> +	/*
> +	 * Select the formatter to use for this FIFO
> +	 *
> +	 * The register definitions imply that different IDs should be used
> +	 * by the DSI formatters depending on if they are in VID or CMD
> +	 * mode, and the manual says they are dedicated but identical.
> +	 * The vendor code uses them as it seems fit.
> +	 */
> +	switch (fmt) {
> +	case MCDE_DSI_FORMATTER_0:
> +		val |= MCDE_CTRLX_FORMTYPE_DSI << MCDE_CTRLX_FORMTYPE_SHIFT;
> +		val |= MCDE_CTRLX_FORMID_DSI0VID << MCDE_CTRLX_FORMID_SHIFT;
> +		break;
> +	case MCDE_DSI_FORMATTER_1:
> +		val |= MCDE_CTRLX_FORMTYPE_DSI << MCDE_CTRLX_FORMTYPE_SHIFT;
> +		val |= MCDE_CTRLX_FORMID_DSI0CMD << MCDE_CTRLX_FORMID_SHIFT;
> +		break;
> +	case MCDE_DSI_FORMATTER_2:
> +		val |= MCDE_CTRLX_FORMTYPE_DSI << MCDE_CTRLX_FORMTYPE_SHIFT;
> +		val |= MCDE_CTRLX_FORMID_DSI1VID << MCDE_CTRLX_FORMID_SHIFT;
> +		break;
> +	case MCDE_DSI_FORMATTER_3:
> +		val |= MCDE_CTRLX_FORMTYPE_DSI << MCDE_CTRLX_FORMTYPE_SHIFT;
> +		val |= MCDE_CTRLX_FORMID_DSI1CMD << MCDE_CTRLX_FORMID_SHIFT;
> +		break;
> +	case MCDE_DSI_FORMATTER_4:
> +		val |= MCDE_CTRLX_FORMTYPE_DSI << MCDE_CTRLX_FORMTYPE_SHIFT;
> +		val |= MCDE_CTRLX_FORMID_DSI2VID << MCDE_CTRLX_FORMID_SHIFT;
> +		break;
> +	case MCDE_DSI_FORMATTER_5:
> +		val |= MCDE_CTRLX_FORMTYPE_DSI << MCDE_CTRLX_FORMTYPE_SHIFT;
> +		val |= MCDE_CTRLX_FORMID_DSI2CMD << MCDE_CTRLX_FORMID_SHIFT;
> +		break;
> +	case MCDE_DPI_FORMATTER_0:
> +		val |= MCDE_CTRLX_FORMTYPE_DPITV << MCDE_CTRLX_FORMTYPE_SHIFT;
> +		val |= MCDE_CTRLX_FORMID_DPIA << MCDE_CTRLX_FORMID_SHIFT;
> +		break;
> +	case MCDE_DPI_FORMATTER_1:
> +		val |= MCDE_CTRLX_FORMTYPE_DPITV << MCDE_CTRLX_FORMTYPE_SHIFT;
> +		val |= MCDE_CTRLX_FORMID_DPIB << MCDE_CTRLX_FORMID_SHIFT;
> +		break;
> +	}
>  	writel(val, mcde->regs + ctrl);
>  
>  	/* Blend source with Alpha 0xff on FIFO */
> @@ -631,17 +701,54 @@ static void mcde_configure_fifo(struct mcde *mcde, enum mcde_fifo fifo,
>  		0xff << MCDE_CRX0_ALPHABLEND_SHIFT;
>  	writel(val, mcde->regs + cr0);
>  
> -	/* Set-up from mcde_fmtr_dsi.c, fmtr_dsi_enable_video() */
> -
> -	/* Use the MCDE clock for this FIFO */
> -	val = MCDE_CRX1_CLKSEL_MCDECLK << MCDE_CRX1_CLKSEL_SHIFT;
> +	spin_lock(&mcde->fifo_crx1_lock);
> +	val = readl(mcde->regs + cr1);
> +	/*
> +	 * Set-up from mcde_fmtr_dsi.c, fmtr_dsi_enable_video()
> +	 * FIXME: a different clock needs to be selected for TV out.
> +	 */
> +	if (mcde->dpi_output) {
> +		struct drm_connector *connector = drm_panel_bridge_connector(mcde->bridge);
> +		u32 bus_format;
> +
> +		/* Assume RGB888 24 bit if we have no further info */
> +		if (!connector->display_info.num_bus_formats) {
> +			dev_info(mcde->dev, "panel does not specify bus format, assume RGB888\n");
> +			bus_format = MEDIA_BUS_FMT_RGB888_1X24;
> +		} else {
> +			bus_format = connector->display_info.bus_formats[0];
> +		}
>  
> -	/* TODO: when adding DPI support add OUTBPP etc here */
> +		/*
> +		 * Set up the CDWIN and OUTBPP for the LCD
> +		 *
> +		 * FIXME: fill this in if you know the correspondance between the MIPI
> +		 * DPI specification and the media bus formats.
> +		 */
> +		val &= ~MCDE_CRX1_CDWIN_MASK;
> +		val &= ~MCDE_CRX1_OUTBPP_MASK;
> +		switch (bus_format) {
> +		case MEDIA_BUS_FMT_RGB888_1X24:
> +			val |= MCDE_CRX1_CDWIN_24BPP << MCDE_CRX1_CDWIN_SHIFT;
> +			val |= MCDE_CRX1_OUTBPP_24BPP << MCDE_CRX1_OUTBPP_SHIFT;
> +			break;
> +		default:
> +			dev_err(mcde->dev, "unknown bus format, assume RGB888\n");
> +			val |= MCDE_CRX1_CDWIN_24BPP << MCDE_CRX1_CDWIN_SHIFT;
> +			val |= MCDE_CRX1_OUTBPP_24BPP << MCDE_CRX1_OUTBPP_SHIFT;
> +			break;
> +		}
> +	} else {
> +		/* Use the MCDE clock for DSI */
> +		val &= ~MCDE_CRX1_CLKSEL_MASK;
> +		val = MCDE_CRX1_CLKSEL_MCDECLK << MCDE_CRX1_CLKSEL_SHIFT;
> +	}
>  	writel(val, mcde->regs + cr1);
> +	spin_unlock(&mcde->fifo_crx1_lock);
>  };
>  
>  static void mcde_configure_dsi_formatter(struct mcde *mcde,
> -					 enum mcde_dsi_formatter fmt,
> +					 enum mcde_formatter fmt,
>  					 u32 formatter_frame,
>  					 int pkt_size)
>  {
> @@ -681,6 +788,9 @@ static void mcde_configure_dsi_formatter(struct mcde *mcde,
>  		delay0 = MCDE_DSIVID2DELAY0;
>  		delay1 = MCDE_DSIVID2DELAY1;
>  		break;
> +	default:
> +		dev_err(mcde->dev, "tried to configure a non-DSI formatter as DSI\n");
> +		return;
>  	}
>  
>  	/*
> @@ -860,6 +970,103 @@ static int mcde_dsi_get_pkt_div(int ppl, int fifo_size)
>  	return 1;
>  }
>  
> +static void mcde_setup_dpi(struct mcde *mcde, const struct drm_display_mode *mode,
> +			   int *fifo_wtrmrk_lvl)
> +{
> +	struct drm_connector *connector = drm_panel_bridge_connector(mcde->bridge);
> +	u32 hsw, hfp, hbp;
> +	u32 vsw, vfp, vbp;
> +	u32 val;
> +
> +	/* FIXME: we only support LCD, implement TV out */
> +	hsw = mode->hsync_end - mode->hsync_start;
> +	hfp = mode->hsync_start - mode->hdisplay;
> +	hbp = mode->htotal - mode->hsync_end;
> +	vsw = mode->vsync_end - mode->vsync_start;
> +	vfp = mode->vsync_start - mode->vdisplay;
> +	vbp = mode->vtotal - mode->vsync_end;
> +
> +	dev_info(mcde->dev, "output on DPI LCD from channel A\n");
> +	/* Display actual values */
> +	dev_info(mcde->dev, "HSW: %d, HFP: %d, HBP: %d, VSW: %d, VFP: %d, VBP: %d\n",
> +		 hsw, hfp, hbp, vsw, vfp, vbp);
> +
> +	/*
> +	 * The pixel fetcher is 128 64-bit words deep = 1024 bytes.
> +	 * One overlay of 32bpp (4 cpp) assumed, fetch 160 pixels.
> +	 * 160 * 4 = 640 bytes.
> +	 */
> +	*fifo_wtrmrk_lvl = 640;
> +
> +	/* Set up the main control, watermark level at 7 */
> +	val = 7 << MCDE_CONF0_IFIFOCTRLWTRMRKLVL_SHIFT;
> +
> +	/*
> +	 * This sets up the internal silicon muxing of the DPI
> +	 * lines. This is how the silicon connects out to the
> +	 * external pins, then the pins need to be further
> +	 * configured into "alternate functions" using pin control
> +	 * to actually get the signals out.
> +	 *
> +	 * FIXME: this is hardcoded to the only setting found in
> +	 * the wild. If we need to use different settings for
> +	 * different DPI displays, make this parameterizable from
> +	 * the device tree.
> +	 */
> +	/* 24 bits DPI: connect Ch A LSB to D[0:7] */
> +	val |= 0 << MCDE_CONF0_OUTMUX0_SHIFT;
> +	/* 24 bits DPI: connect Ch A MID to D[8:15] */
> +	val |= 1 << MCDE_CONF0_OUTMUX1_SHIFT;
> +	/* Don't care about this muxing */
> +	val |= 0 << MCDE_CONF0_OUTMUX2_SHIFT;
> +	/* Don't care about this muxing */
> +	val |= 0 << MCDE_CONF0_OUTMUX3_SHIFT;
> +	/* 24 bits DPI: connect Ch A MSB to D[32:39] */
> +	val |= 2 << MCDE_CONF0_OUTMUX4_SHIFT;
> +	/* Syncmux bits zero: DPI channel A */
> +	writel(val, mcde->regs + MCDE_CONF0);
> +
> +	/* This hammers us into LCD mode */
> +	writel(0, mcde->regs + MCDE_TVCRA);
> +
> +	/* Front porch and sync width */
> +	val = (vsw << MCDE_TVBL1_BEL1_SHIFT);
> +	val |= (vfp << MCDE_TVBL1_BSL1_SHIFT);
> +	writel(val, mcde->regs + MCDE_TVBL1A);
> +	/* The vendor driver sets the same value into TVBL2A */
> +	writel(val, mcde->regs + MCDE_TVBL2A);
> +
> +	/* Vertical back porch */
> +	val = (vbp << MCDE_TVDVO_DVO1_SHIFT);
> +	/* The vendor drivers sets the same value into TVDVOA */
> +	val |= (vbp << MCDE_TVDVO_DVO2_SHIFT);
> +	writel(val, mcde->regs + MCDE_TVDVOA);
> +
> +	/* Horizontal back porch, as 0 = 1 cycle we need to subtract 1 */
> +	writel((hbp - 1), mcde->regs + MCDE_TVTIM1A);
> +
> +	/* Horizongal sync width and horizonal front porch, 0 = 1 cycle */
> +	val = ((hsw - 1) << MCDE_TVLBALW_LBW_SHIFT);
> +	val |= ((hfp - 1) << MCDE_TVLBALW_ALW_SHIFT);
> +	writel(val, mcde->regs + MCDE_TVLBALWA);
> +
> +	/* Blank some TV registers we don't use */
> +	writel(0, mcde->regs + MCDE_TVISLA);
> +	writel(0, mcde->regs + MCDE_TVBLUA);
> +
> +	/* Set up sync inversion etc */
> +	val = 0;
> +	if (mode->flags & DRM_MODE_FLAG_NHSYNC)
> +		val |= MCDE_LCDTIM1B_IHS;
> +	if (mode->flags & DRM_MODE_FLAG_NVSYNC)
> +		val |= MCDE_LCDTIM1B_IVS;
> +	if (connector->display_info.bus_flags & DRM_BUS_FLAG_DE_LOW)
> +		val |= MCDE_LCDTIM1B_IOE;
> +	if (connector->display_info.bus_flags & DRM_BUS_FLAG_PIXDATA_DRIVE_NEGEDGE)
> +		val |= MCDE_LCDTIM1B_IPC;
> +	writel(val, mcde->regs + MCDE_LCDTIM1A);
> +}
> +
>  static void mcde_setup_dsi(struct mcde *mcde, const struct drm_display_mode *mode,
>  			   int cpp, int *fifo_wtrmrk_lvl, int *dsi_formatter_frame,
>  			   int *dsi_pkt_size)
> @@ -977,8 +1184,11 @@ static void mcde_display_enable(struct drm_simple_display_pipe *pipe,
>  	writel(0, mcde->regs + MCDE_IMSCERR);
>  	writel(0xFFFFFFFF, mcde->regs + MCDE_RISERR);
>  
> -	mcde_setup_dsi(mcde, mode, cpp, &fifo_wtrmrk,
> -		       &dsi_formatter_frame, &dsi_pkt_size);
> +	if (mcde->dpi_output)
> +		mcde_setup_dpi(mcde, mode, &fifo_wtrmrk);
> +	else
> +		mcde_setup_dsi(mcde, mode, cpp, &fifo_wtrmrk,
> +			       &dsi_formatter_frame, &dsi_pkt_size);
>  
>  	mcde->stride = mode->hdisplay * cpp;
>  	dev_dbg(drm->dev, "Overlay line stride: %u bytes\n",
> @@ -1010,29 +1220,47 @@ static void mcde_display_enable(struct drm_simple_display_pipe *pipe,
>  	 */
>  	mcde_configure_channel(mcde, MCDE_CHANNEL_0, MCDE_FIFO_A, mode);
>  
> -	/* Configure FIFO A to use DSI formatter 0 */
> -	mcde_configure_fifo(mcde, MCDE_FIFO_A, MCDE_DSI_FORMATTER_0,
> -			    fifo_wtrmrk);
> +	if (mcde->dpi_output) {
> +		unsigned long lcd_freq;
> +
> +		/* Configure FIFO A to use DPI formatter 0 */
> +		mcde_configure_fifo(mcde, MCDE_FIFO_A, MCDE_DPI_FORMATTER_0,
> +				    fifo_wtrmrk);
> +
> +		/* Set up and enable the LCD clock */
> +		lcd_freq = clk_round_rate(mcde->fifoa_clk, mode->clock * 1000);
> +		ret = clk_set_rate(mcde->fifoa_clk, lcd_freq);
> +		if (ret)
> +			dev_err(mcde->dev, "failed to set LCD clock rate %lu Hz\n",
> +				lcd_freq);
> +		ret = clk_prepare_enable(mcde->fifoa_clk);
> +		if (ret) {
> +			dev_err(mcde->dev, "failed to enable FIFO A DPI clock\n");
> +			return;
> +		}
> +		dev_info(mcde->dev, "LCD FIFO A clk rate %lu Hz\n",
> +			 clk_get_rate(mcde->fifoa_clk));
> +	} else {
> +		/* Configure FIFO A to use DSI formatter 0 */
> +		mcde_configure_fifo(mcde, MCDE_FIFO_A, MCDE_DSI_FORMATTER_0,
> +				    fifo_wtrmrk);
>  
> -	/*
> -	 * This brings up the DSI bridge which is tightly connected
> -	 * to the MCDE DSI formatter.
> -	 *
> -	 * FIXME: if we want to use another formatter, such as DPI,
> -	 * we need to be more elaborate here and select the appropriate
> -	 * bridge.
> -	 */
> -	mcde_dsi_enable(mcde->bridge);
> +		/*
> +		 * This brings up the DSI bridge which is tightly connected
> +		 * to the MCDE DSI formatter.
> +		 */
> +		mcde_dsi_enable(mcde->bridge);
>  
> -	/* Configure the DSI formatter 0 for the DSI panel output */
> -	mcde_configure_dsi_formatter(mcde, MCDE_DSI_FORMATTER_0,
> -				     dsi_formatter_frame, dsi_pkt_size);
> +		/* Configure the DSI formatter 0 for the DSI panel output */
> +		mcde_configure_dsi_formatter(mcde, MCDE_DSI_FORMATTER_0,
> +					     dsi_formatter_frame, dsi_pkt_size);
> +	}
>  
>  	switch (mcde->flow_mode) {
>  	case MCDE_COMMAND_TE_FLOW:
>  	case MCDE_COMMAND_BTA_TE_FLOW:
>  	case MCDE_VIDEO_TE_FLOW:
> -		/* We are using TE in some comination */
> +		/* We are using TE in some combination */
>  		if (mode->flags & DRM_MODE_FLAG_NVSYNC)
>  			val = MCDE_VSCRC_VSPOL;
>  		else
> @@ -1084,8 +1312,12 @@ static void mcde_display_disable(struct drm_simple_display_pipe *pipe)
>  	/* Disable FIFO A flow */
>  	mcde_disable_fifo(mcde, MCDE_FIFO_A, true);
>  
> -	/* This disables the DSI bridge */
> -	mcde_dsi_disable(mcde->bridge);
> +	if (mcde->dpi_output) {
> +		clk_disable_unprepare(mcde->fifoa_clk);
> +	} else {
> +		/* This disables the DSI bridge */
> +		mcde_dsi_disable(mcde->bridge);
> +	}
>  
>  	event = crtc->state->event;
>  	if (event) {
> @@ -1276,6 +1508,10 @@ int mcde_display_init(struct drm_device *drm)
>  		DRM_FORMAT_YUV422,
>  	};
>  
> +	ret = mcde_init_clock_divider(mcde);
> +	if (ret)
> +		return ret;
> +
>  	ret = drm_simple_display_pipe_init(drm, &mcde->pipe,
>  					   &mcde_display_funcs,
>  					   formats, ARRAY_SIZE(formats),
> diff --git a/drivers/gpu/drm/mcde/mcde_display_regs.h b/drivers/gpu/drm/mcde/mcde_display_regs.h
> index d3ac7ef5ff9a..ae76da8a2138 100644
> --- a/drivers/gpu/drm/mcde/mcde_display_regs.h
> +++ b/drivers/gpu/drm/mcde/mcde_display_regs.h
> @@ -215,6 +215,80 @@
>  #define MCDE_OVLXCOMP_Z_SHIFT 27
>  #define MCDE_OVLXCOMP_Z_MASK 0x78000000
>  
> +/* DPI/TV configuration registers, channel A and B */
> +#define MCDE_TVCRA 0x00000838
> +#define MCDE_TVCRB 0x00000A38
> +#define MCDE_TVCR_MOD_TV BIT(0) /* 0 = LCD mode */
> +#define MCDE_TVCR_INTEREN BIT(1)
> +#define MCDE_TVCR_IFIELD BIT(2)
> +#define MCDE_TVCR_TVMODE_SDTV_656P (0 << 3)
> +#define MCDE_TVCR_TVMODE_SDTV_656P_LE (3 << 3)
> +#define MCDE_TVCR_TVMODE_SDTV_656P_BE (4 << 3)
> +#define MCDE_TVCR_SDTVMODE_Y0CBY1CR (0 << 6)
> +#define MCDE_TVCR_SDTVMODE_CBY0CRY1 (1 << 6)
> +#define MCDE_TVCR_AVRGEN BIT(8)
> +#define MCDE_TVCR_CKINV BIT(9)
> +
> +/* TV blanking control register 1, channel A and B */
> +#define MCDE_TVBL1A 0x0000083C
> +#define MCDE_TVBL1B 0x00000A3C
> +#define MCDE_TVBL1_BEL1_SHIFT 0 /* VFP vertical front porch 11 bits */
> +#define MCDE_TVBL1_BSL1_SHIFT 16 /* VSW vertical sync pulse width 11 bits */
> +
> +/* Pixel processing TV start line, channel A and B */
> +#define MCDE_TVISLA 0x00000840
> +#define MCDE_TVISLB 0x00000A40
> +#define MCDE_TVISL_FSL1_SHIFT 0 /* Field 1 identification start line 11 bits */
> +#define MCDE_TVISL_FSL2_SHIFT 16 /* Field 2 identification start line 11 bits */
> +
> +/* Pixel processing TV DVO offset */
> +#define MCDE_TVDVOA 0x00000844
> +#define MCDE_TVDVOB 0x00000A44
> +#define MCDE_TVDVO_DVO1_SHIFT 0 /* VBP vertical back porch 0 = 0 */
> +#define MCDE_TVDVO_DVO2_SHIFT 16
> +
> +/*
> + * Pixel processing TV Timing 1
> + * HBP horizontal back porch 11 bits horizontal offset
> + * 0 = 1 pixel HBP, 255 = 256 pixels, so actual value - 1
> + */
> +#define MCDE_TVTIM1A 0x0000084C
> +#define MCDE_TVTIM1B 0x00000A4C
> +
> +/* Pixel processing TV LBALW */
> +/* 0 = 1 clock cycle, 255 = 256 clock cycles */
> +#define MCDE_TVLBALWA 0x00000850
> +#define MCDE_TVLBALWB 0x00000A50
> +#define MCDE_TVLBALW_LBW_SHIFT 0 /* HSW horizonal sync width, line blanking width 11 bits */
> +#define MCDE_TVLBALW_ALW_SHIFT 16 /* HFP horizontal front porch, active line width 11 bits */
> +
> +/* TV blanking control register 1, channel A and B */
> +#define MCDE_TVBL2A 0x00000854
> +#define MCDE_TVBL2B 0x00000A54
> +#define MCDE_TVBL2_BEL2_SHIFT 0 /* Field 2 blanking end line 11 bits */
> +#define MCDE_TVBL2_BSL2_SHIFT 16 /* Field 2 blanking start line 11 bits */
> +
> +/* Pixel processing TV background */
> +#define MCDE_TVBLUA 0x00000858
> +#define MCDE_TVBLUB 0x00000A58
> +#define MCDE_TVBLU_TVBLU_SHIFT 0 /* 8 bits luminance */
> +#define MCDE_TVBLU_TVBCB_SHIFT 8 /* 8 bits Cb chrominance */
> +#define MCDE_TVBLU_TVBCR_SHIFT 16 /* 8 bits Cr chrominance */
> +
> +/* Pixel processing LCD timing 1 */
> +#define MCDE_LCDTIM1A 0x00000860
> +#define MCDE_LCDTIM1B 0x00000A60
> +/* inverted vertical sync pulse for HRTFT 0 = active low, 1 active high */
> +#define MCDE_LCDTIM1B_IVP BIT(19)
> +/* inverted vertical sync, 0 = active high (the normal), 1 = active low */
> +#define MCDE_LCDTIM1B_IVS BIT(20)
> +/* inverted horizontal sync, 0 = active high (the normal), 1 = active low */
> +#define MCDE_LCDTIM1B_IHS BIT(21)
> +/* inverted panel clock 0 = rising edge data out, 1 = falling edge data out */
> +#define MCDE_LCDTIM1B_IPC BIT(22)
> +/* invert output enable 0 = active high, 1 = active low */
> +#define MCDE_LCDTIM1B_IOE BIT(23)
> +
>  #define MCDE_CRC 0x00000C00
>  #define MCDE_CRC_C1EN BIT(2)
>  #define MCDE_CRC_C2EN BIT(3)
> @@ -360,6 +434,7 @@
>  #define MCDE_CRB1 0x00000A04
>  #define MCDE_CRX1_PCD_SHIFT 0
>  #define MCDE_CRX1_PCD_MASK 0x000003FF
> +#define MCDE_CRX1_PCD_BITS 10
>  #define MCDE_CRX1_CLKSEL_SHIFT 10
>  #define MCDE_CRX1_CLKSEL_MASK 0x00001C00
>  #define MCDE_CRX1_CLKSEL_CLKPLL72 0
> @@ -421,8 +496,20 @@
>  #define MCDE_ROTACONF 0x0000087C
>  #define MCDE_ROTBCONF 0x00000A7C
>  
> +/* Synchronization event configuration */
>  #define MCDE_SYNCHCONFA 0x00000880
>  #define MCDE_SYNCHCONFB 0x00000A80
> +#define MCDE_SYNCHCONF_HWREQVEVENT_SHIFT 0
> +#define MCDE_SYNCHCONF_HWREQVEVENT_VSYNC (0 << 0)
> +#define MCDE_SYNCHCONF_HWREQVEVENT_BACK_PORCH (1 << 0)
> +#define MCDE_SYNCHCONF_HWREQVEVENT_ACTIVE_VIDEO (2 << 0)
> +#define MCDE_SYNCHCONF_HWREQVEVENT_FRONT_PORCH (3 << 0)
> +#define MCDE_SYNCHCONF_HWREQVCNT_SHIFT 2 /* 14 bits */
> +#define MCDE_SYNCHCONF_SWINTVEVENT_VSYNC (0 << 16)
> +#define MCDE_SYNCHCONF_SWINTVEVENT_BACK_PORCH (1 << 16)
> +#define MCDE_SYNCHCONF_SWINTVEVENT_ACTIVE_VIDEO (2 << 16)
> +#define MCDE_SYNCHCONF_SWINTVEVENT_FRONT_PORCH (3 << 16)
> +#define MCDE_SYNCHCONF_SWINTVCNT_SHIFT 18 /* 14 bits */
>  
>  /* Channel A+B control registers */
>  #define MCDE_CTRLA 0x00000884
> diff --git a/drivers/gpu/drm/mcde/mcde_drm.h b/drivers/gpu/drm/mcde/mcde_drm.h
> index 8253e2f9993e..ecb70b4b737c 100644
> --- a/drivers/gpu/drm/mcde/mcde_drm.h
> +++ b/drivers/gpu/drm/mcde/mcde_drm.h
> @@ -62,6 +62,8 @@ enum mcde_flow_mode {
>  	MCDE_VIDEO_TE_FLOW,
>  	/* Video mode with the formatter itself as sync source */
>  	MCDE_VIDEO_FORMATTER_FLOW,
> +	/* DPI video with the formatter itsels as sync source */
> +	MCDE_DPI_FORMATTER_FLOW,
>  };
>  
>  struct mcde {
> @@ -72,6 +74,7 @@ struct mcde {
>  	struct drm_connector *connector;
>  	struct drm_simple_display_pipe pipe;
>  	struct mipi_dsi_device *mdsi;
> +	bool dpi_output;
>  	s16 stride;
>  	enum mcde_flow_mode flow_mode;
>  	unsigned int flow_active;
> @@ -82,6 +85,11 @@ struct mcde {
>  	struct clk *mcde_clk;
>  	struct clk *lcd_clk;
>  	struct clk *hdmi_clk;
> +	/* Handles to the clock dividers for FIFO A and B */
> +	struct clk *fifoa_clk;
> +	struct clk *fifob_clk;
> +	/* Locks the MCDE FIFO control register A and B */
> +	spinlock_t fifo_crx1_lock;
>  
>  	struct regulator *epod;
>  	struct regulator *vana;
> @@ -105,4 +113,6 @@ void mcde_display_irq(struct mcde *mcde);
>  void mcde_display_disable_irqs(struct mcde *mcde);
>  int mcde_display_init(struct drm_device *drm);
>  
> +int mcde_init_clock_divider(struct mcde *mcde);
> +
>  #endif /* _MCDE_DRM_H_ */
> diff --git a/drivers/gpu/drm/mcde/mcde_drv.c b/drivers/gpu/drm/mcde/mcde_drv.c
> index 92f8bd907193..c890ce24a513 100644
> --- a/drivers/gpu/drm/mcde/mcde_drv.c
> +++ b/drivers/gpu/drm/mcde/mcde_drv.c
> @@ -22,13 +22,13 @@
>   * The hardware has four display pipes, and the layout is a little
>   * bit like this::
>   *
> - *   Memory     -> Overlay -> Channel -> FIFO -> 5 formatters -> DSI/DPI
> - *   External      0..5       0..3       A,B,    3 x DSI         bridge
> + *   Memory     -> Overlay -> Channel -> FIFO -> 8 formatters -> DSI/DPI
> + *   External      0..5       0..3       A,B,    6 x DSI         bridge
>   *   source 0..9                         C0,C1   2 x DPI
>   *
>   * FIFOs A and B are for LCD and HDMI while FIFO CO/C1 are for
>   * panels with embedded buffer.
> - * 3 of the formatters are for DSI.
> + * 6 of the formatters are for DSI, 3 pairs for VID/CMD respectively.
>   * 2 of the formatters are for DPI.
>   *
>   * Behind the formatters are the DSI or DPI ports that route to
> @@ -130,9 +130,37 @@ static int mcde_modeset_init(struct drm_device *drm)
>  	struct mcde *mcde = to_mcde(drm);
>  	int ret;
>  
> +	/*
> +	 * If no other bridge was found, check if we have a DPI panel or
> +	 * any other bridge connected directly to the MCDE DPI output.
> +	 * If a DSI bridge is found, DSI will take precedence.
> +	 *
> +	 * TODO: more elaborate bridge selection if we have more than one
> +	 * thing attached to the system.
> +	 */
>  	if (!mcde->bridge) {
> -		dev_err(drm->dev, "no display output bridge yet\n");
> -		return -EPROBE_DEFER;
> +		struct drm_panel *panel;
> +		struct drm_bridge *bridge;
> +
> +		ret = drm_of_find_panel_or_bridge(drm->dev->of_node,
> +						  0, 0, &panel, &bridge);
> +		if (ret) {
> +			dev_err(drm->dev,
> +				"Could not locate any output bridge or panel\n");
> +			return ret;
> +		}
> +		if (panel) {
> +			bridge = drm_panel_bridge_add_typed(panel,
> +					DRM_MODE_CONNECTOR_DPI);
> +			if (IS_ERR(bridge)) {
> +				dev_err(drm->dev,
> +					"Could not connect panel bridge\n");
> +				return PTR_ERR(bridge);
> +			}
> +		}
> +		mcde->dpi_output = true;
> +		mcde->bridge = bridge;
> +		mcde->flow_mode = MCDE_DPI_FORMATTER_FLOW;
>  	}
>  
>  	mode_config = &drm->mode_config;
> @@ -156,13 +184,7 @@ static int mcde_modeset_init(struct drm_device *drm)
>  		return ret;
>  	}
>  
> -	/*
> -	 * Attach the DSI bridge
> -	 *
> -	 * TODO: when adding support for the DPI bridge or several DSI bridges,
> -	 * we selectively connect the bridge(s) here instead of this simple
> -	 * attachment.
> -	 */
> +	/* Attach the bridge. */
>  	ret = drm_simple_display_pipe_attach_bridge(&mcde->pipe,
>  						    mcde->bridge);
>  	if (ret) {

Patch looks good - but it was more a visual check as a lot of the code
is HW dependent.

Acked-by: Sam Ravnborg <sam@xxxxxxxxxxxx>

_______________________________________________
dri-devel mailing list
dri-devel@xxxxxxxxxxxxxxxxxxxxx
https://lists.freedesktop.org/mailman/listinfo/dri-devel



[Index of Archives]     [Linux DRI Users]     [Linux Intel Graphics]     [Linux USB Devel]     [Video for Linux]     [Linux Audio Users]     [Yosemite News]     [Linux Kernel]     [Linux SCSI]     [XFree86]     [Linux USB Devel]     [Video for Linux]     [Linux Audio Users]     [Linux Kernel]     [Linux SCSI]     [XFree86]
  Powered by Linux