Re: [PATCH v2 3/3] phy: Add driver for mixel dphy found on imx8

["Guido Günther" <agx@sigxcpu.org>]

Hi Robert,
On Wed, Feb 06, 2019 at 03:28:07PM +0000, Robert Chiras wrote:
> Hi Guido,
> 
> Thanks for picking this up. It's interesting to see that a lot has
> changed in the PHY API and the phy can be now configured through the
> API instead of exported function as I did in the NXP tree.
> 
> I was going through your implementation and I noticed you also added
> the phy_ref clock to this driver too. This is good, since the DPHY
> needs this clock, but I have a question related to the other clocks:
> According to the Northwest Logic reference manual (the DSI host that
> uses this DPHY), the host relies on the TX clock in order to configure
> the DPHY. Is this driver relying on it's user to also enable the TX
> clock?

Yes, I think that would be best. In fact due to lack of reference
manuals for nwl and mixel I didn't even know exactly which clocks needed
to be on already so I currently set for enabling this after the nwl
clocks. Are these manuals available publicly somewhere, I couldn't find
them?

> Also: did you test this driver? Because I have a version of the patches
> from NXP tree rebased on top of latest linux-next and I have a working

Hmm...could you (maybe off list) send the boot output with DEBUG 1
at the top of the driver and drm.debug=0x2f on the kernel command line?
Maybe I can spot something.

> version of eLCDIF with Raydium RM67191 DSI panel on mScale850D
> (i.MX8MQ). And I tried using this driver but there is no signal on the
> screen, even through the register values are all identical. Next, I'll
> try to debug why isn't this working on my setup.

I'm testing this on the Librem 5 devkit with a rockchip panel atm using
DCSS not eLCDIF though. My plan is to move to the NXP evk in the not so
far future to make this easier to reproduce.

> Other than the above questions, I have some suggestions inline.
> 
> Best regards,
> Robert
> 
> 
> On Vi, 2019-02-01 at 09:49 +0100, Guido Günther wrote:
> > This adds support for the Mixel DPHY as found on i.MX8 CPUs but since
> > this is an IP core it will likely be found on others in the future.
> > So
> > instead of adding this to the nwl host driver make it a generic PHY
> > driver.
> > 
> > The driver supports the i.MX8MQ. Support for i.MX8QM and i.MX8QXP can
> > be
> > added once the necessary system controller bits are in via
> > mixel_dphy_devdata.
> > 
> > Signed-off-by: Guido Günther <agx@sigxcpu.org>
> > ---
> >  drivers/phy/freescale/Kconfig                 |   9 +
> >  drivers/phy/freescale/Makefile                |   1 +
> >  .../phy/freescale/phy-fsl-imx8-mipi-dphy.c    | 494
> > ++++++++++++++++++
> >  3 files changed, 504 insertions(+)
> >  create mode 100644 drivers/phy/freescale/phy-fsl-imx8-mipi-dphy.c
> > 
> > diff --git a/drivers/phy/freescale/Kconfig
> > b/drivers/phy/freescale/Kconfig
> > index 832670b4952b..43a5ca25d44b 100644
> > --- a/drivers/phy/freescale/Kconfig
> > +++ b/drivers/phy/freescale/Kconfig
> > @@ -3,3 +3,12 @@ config PHY_FSL_IMX8MQ_USB
> >  	depends on OF && HAS_IOMEM
> >  	select GENERIC_PHY
> >  	default ARCH_MXC && ARM64
> > +
> > +config PHY_MIXEL_MIPI_DPHY
> > +	tristate "Mixel MIPI DSI PHY support"
> > +	depends on OF
> > +	select GENERIC_PHY
> > +	select GENERIC_PHY_MIPI_DPHY
> > +	help
> > +	  Enable this to add support for the Mixel DSI PHY as found
> > +	  on NXP's i.MX8 family of SOCs.
> > diff --git a/drivers/phy/freescale/Makefile
> > b/drivers/phy/freescale/Makefile
> > index dc2b3f1f2f80..07491c926a2c 100644
> > --- a/drivers/phy/freescale/Makefile
> > +++ b/drivers/phy/freescale/Makefile
> > @@ -1 +1,2 @@
> >  obj-$(CONFIG_PHY_FSL_IMX8MQ_USB)	+= phy-fsl-imx8mq-usb.o
> > +obj-$(CONFIG_PHY_MIXEL_MIPI_DPHY)	+= phy-fsl-imx8-mipi-dphy.o
> > diff --git a/drivers/phy/freescale/phy-fsl-imx8-mipi-dphy.c
> > b/drivers/phy/freescale/phy-fsl-imx8-mipi-dphy.c
> > new file mode 100644
> > index 000000000000..4b182f2eaa6e
> > --- /dev/null
> > +++ b/drivers/phy/freescale/phy-fsl-imx8-mipi-dphy.c
> > @@ -0,0 +1,494 @@
> > +// SPDX-License-Identifier: GPL-2.0+
> > +/*
> > + * Copyright 2017,2018 NXP
> > + * Copyright 2019 Purism SPC
> > + */
> > +
> > +#include <linux/clk.h>
> > +#include <linux/clk-provider.h>
> > +#include <linux/delay.h>
> > +#include <linux/io.h>
> > +#include <linux/kernel.h>
> > +#include <linux/module.h>
> > +#include <linux/of.h>
> > +#include <linux/of_platform.h>
> > +#include <linux/regmap.h>
> > +#include <linux/phy/phy.h>
> > +#include <linux/platform_device.h>
> > +
> > +/* DPHY registers */
> > +#define DPHY_PD_DPHY			0x00
> > +#define DPHY_M_PRG_HS_PREPARE		0x04
> > +#define DPHY_MC_PRG_HS_PREPARE		0x08
> > +#define DPHY_M_PRG_HS_ZERO		0x0c
> > +#define DPHY_MC_PRG_HS_ZERO		0x10
> > +#define DPHY_M_PRG_HS_TRAIL		0x14
> > +#define DPHY_MC_PRG_HS_TRAIL		0x18
> > +#define DPHY_PD_PLL			0x1c
> > +#define DPHY_TST			0x20
> > +#define DPHY_CN				0x24
> > +#define DPHY_CM				0x28
> > +#define DPHY_CO				0x2c
> > +#define DPHY_LOCK			0x30
> > +#define DPHY_LOCK_BYP			0x34
> > +#define DPHY_REG_BYPASS_PLL		0x4C
> > +
> > +#define MBPS(x) ((x) * 1000000)
> > +
> > +#define DATA_RATE_MAX_SPEED MBPS(1500)
> > +#define DATA_RATE_MIN_SPEED MBPS(80)
> > +
> > +#define CN_BUF	0xcb7a89c0
> > +#define CO_BUF	0x63
> > +#define CM(x)	(				\
> > +		((x) <	32)?0xe0|((x)-16) :	\
> > +		((x) <	64)?0xc0|((x)-32) :	\
> > +		((x) < 128)?0x80|((x)-64) :	\
> > +		((x) - 128))
> > +#define CN(x)	(((x) == 1)?0x1f : (((CN_BUF)>>((x)-1))&0x1f))
> > +#define CO(x)	((CO_BUF)>>(8-(x))&0x3)
> > +
> > +/* PHY power on is LOW_ENABLE */
> > +#define PWR_ON	0
> > +#define PWR_OFF	1
> > +
> > +enum mixel_dphy_devtype {
> > +	MIXEL_IMX8MQ,
> > +};
> > +
> > +struct mixel_dphy_devdata {
> > +	u8 reg_tx_rcal;
> > +	u8 reg_auto_pd_en;
> > +	u8 reg_rxlprp;
> > +	u8 reg_rxcdrp;
> > +	u8 reg_rxhs_settle;
> > +};
> > +
> > +static const struct mixel_dphy_devdata mixel_dphy_devdata[] = {
> > +	[MIXEL_IMX8MQ] = {
> > +		.reg_tx_rcal = 0x38,
> > +		.reg_auto_pd_en = 0x3c,
> > +		.reg_rxlprp = 0x40,
> > +		.reg_rxcdrp = 0x44,
> > +		.reg_rxhs_settle = 0x48,
> > +	},
> > +};
> > +
> > +struct mixel_dphy_cfg {
> > +	/* DPHY PLL parameters */
> > +	u32 cm;
> > +	u32 cn;
> > +	u32 co;
> > +	/* DPHY register values */
> > +	u8 mc_prg_hs_prepare;
> > +	u8 m_prg_hs_prepare;
> > +	u8 mc_prg_hs_zero;
> > +	u8 m_prg_hs_zero;
> > +	u8 mc_prg_hs_trail;
> > +	u8 m_prg_hs_trail;
> > +	u8 rxhs_settle;
> > +};
> > +
> > +struct mixel_dphy_priv {
> > +	struct mixel_dphy_cfg cfg;
> > +	struct regmap *regs;
> > +	struct clk *phy_ref_clk;
> > +	const struct mixel_dphy_devdata *devdata;
> > +};
> > +
> > +static const struct regmap_config mixel_dphy_regmap_config = {
> > +	.reg_bits = 8,
> > +	.val_bits = 32,
> > +	.reg_stride = 4,
> > +	.max_register = DPHY_REG_BYPASS_PLL,
> > +	.name = "mipi-dphy",
> > +};
> > +
> > +static inline u32 phy_read(struct phy *phy, unsigned int reg)
> > +{
> > +	struct mixel_dphy_priv *priv = phy_get_drvdata(phy);
> > +	u32 val;
> > +	int ret;
> > +
> > +	ret = regmap_read(priv->regs, reg, &val);
> > +	if (ret < 0)
> > +		dev_err(&phy->dev, "Failed to read DPHY reg %d: %d",
> > reg, ret);
> > +	return val;
> > +}
> > +
> > +static inline void phy_write(struct phy *phy, u32 value, unsigned
> > int reg)
> > +{
> > +	struct mixel_dphy_priv *priv = phy_get_drvdata(phy);
> > +	int ret;
> > +
> > +	ret = regmap_write(priv->regs, reg, value);
> > +	if (ret < 0)
> > +		dev_err(&phy->dev, "Failed to write DPHY reg %d:
> > %d", reg, ret);
> > +}
> > +
> > +/*
> > + * Find a ratio close to the desired one using continued fraction
> > + * approximation ending either at exact match or maximum allowed
> > + * nominator, denominator.
> > + */
> > +static void get_best_ratio(unsigned long *pnum, unsigned long
> > *pdenom,
> > +			   unsigned int max_n, unsigned int max_d)
> > +{
> > +	unsigned long a = *pnum;
> > +	unsigned long b = *pdenom;
> > +	unsigned long c;
> > +	unsigned int n[] = {0, 1};
> > +	unsigned int d[] = {1, 0};
> > +	unsigned int whole;
> > +	unsigned int i = 1;
> > +
> > +	while (b) {
> > +		i ^= 1;
> > +		whole = a / b;
> > +		n[i] += (n[i ^ 1] * whole);
> > +		d[i] += (d[i ^ 1] * whole);
> > +		if ((n[i] > max_n) || (d[i] > max_d)) {
> > +			i ^= 1;
> > +			break;
> > +		}
> > +		c = a - (b * whole);
> > +		a = b;
> > +		b = c;
> > +	}
> > +	*pnum = n[i];
> > +	*pdenom = d[i];
> > +}
> > +
> > +static int mixel_dphy_config_from_opts(struct phy *phy,
> > +	       struct phy_configure_opts_mipi_dphy *dphy_opts,
> > +	       struct mixel_dphy_cfg *cfg)
> > +{
> > +	struct mixel_dphy_priv *priv = dev_get_drvdata(phy-
> > >dev.parent);
> > +	unsigned long ref_clk = clk_get_rate(priv->phy_ref_clk);
> > +	unsigned long lp_t, numerator, denominator, frequency;
> > +	u32 n;
> > +	int i;
> > +
> > +	if (dphy_opts->hs_clk_rate > DATA_RATE_MAX_SPEED ||
> > +	    dphy_opts->hs_clk_rate < DATA_RATE_MIN_SPEED)
> > +		return -EINVAL;
> > +
> > +	numerator = dphy_opts->hs_clk_rate;
> > +	denominator = ref_clk;
> > +	get_best_ratio(&numerator, &denominator, 255, 256);
> > +	if (!numerator || !denominator) {
> > +		dev_err(&phy->dev, "Invalid %ld/%ld for %ld/%ld\n",
> > +			numerator, denominator,
> > +			dphy_opts->hs_clk_rate, ref_clk);
> > +		return -EINVAL;
> > +	}
> > +
> > +	while ((numerator < 16) && (denominator <= 128)) {
> > +		numerator <<= 1;
> > +		denominator <<= 1;
> > +	}
> > +	/*
> > +	 * CM ranges between 16 and 255
> > +	 * CN ranges between 1 and 32
> > +	 * CO is power of 2: 1, 2, 4, 8
> > +	 */
> > +	i = __ffs(denominator);
> > +	if (i > 3)
> > +		i = 3;
> > +	cfg->cn = denominator >> i;
> > +	cfg->co = 1 << i;
> > +	cfg->cm = numerator;
> > +
> > +	if (cfg->cm < 16 || cfg->cm > 255 ||
> > +	    cfg->cn < 1 || cfg->cn > 32 ||
> > +	    cfg->co < 1 || cfg->co > 8) {
> > +		dev_err(&phy->dev, "Invalid CM/CN/CO values:
> > %u/%u/%u\n",
> > +			cfg->cm, cfg->cn, cfg->co);
> > +		dev_err(&phy->dev, "for hs_clk/ref_clk=%ld/%ld ⩰
> > %ld/%ld\n",
> > +			dphy_opts->hs_clk_rate, ref_clk,
> > +			numerator, denominator);
> > +		return -EINVAL;
> > +	}
> > +
> > +	frequency = ref_clk * numerator / (2 * denominator);
> > +	dev_info(&phy->dev, "freq=%ld, hs_clk/ref_clk=%ld/%ld ⩰
> > %ld/%ld\n",
> > +		 frequency, dphy_opts->hs_clk_rate, ref_clk,
> > +		 numerator, denominator);
> > +
> > +	/* LP clock period */
> > +	lp_t = 1000000000000L / dphy_opts->lp_clk_rate; /* ps */
> > +	dev_dbg(&phy->dev, "LP clock %lu, period: %lu ps\n",
> > +		dphy_opts->lp_clk_rate, lp_t);
> > +	/*
> > +	 *  hs_prepare: in lp clock periods
> > +	 */
> > +	if (2 * dphy_opts->hs_prepare > 5 * lp_t) {
> > +		dev_err(&phy->dev,
> > +			"hs_prepare (%u) > 2.5 * lp clock period
> > (%lu)",
> > +			dphy_opts->hs_prepare, lp_t);
> > +		return -EINVAL;
> > +	}
> > +	/* 00: lp_t, 01: 1.5 * lp_t, 10: 2 * lp_t, 11: 2.5 * lp_t */
> > +	if (dphy_opts->hs_prepare < lp_t)
> > +		n = 0;
> > +	else
> > +		n = 2 * (dphy_opts->hs_prepare - lp_t) / lp_t;
> > +	cfg->m_prg_hs_prepare = n;
> > +
> > +	/*
> > +	 * clk_prepare: in lp clock periods
> > +	 */
> > +	if (2 * dphy_opts->clk_prepare > 3 * lp_t) {
> > +		dev_err(&phy->dev,
> > +			"clk_prepare (%u) > 1.5 * lp clock period
> > (%lu)",
> > +			dphy_opts->clk_prepare, lp_t);
> > +		return -EINVAL;
> > +	}
> > +	/* 00: lp_t, 01: 1.5 * lp_t */
> > +	cfg->mc_prg_hs_prepare = dphy_opts->clk_prepare > lp_t ? 1 :
> > 0;
> 
> Since hs_prepare and clk_prepare both depend on the current HS/LP clock
> rates shouldn't be better to calculate these two here? Instead of doing
>  this in the DSI host driver? This way all the DPHY specific
> calculations whould in one place.

The idea of doing this in the host driver was that the host driver knows
about any special timing requirements from e.g. the panel so it can
adjust values as needed and the PHYs job would be to adhere to these
values. Does that make sense to you too?

> > +
> > +	/*
> > +	 * hs_zero: forumula from NXP BSP
> > +	 */
> > +	n = (144 * (dphy_opts->hs_clk_rate / 1000000) - 47500) /
> > 10000;
> > +	cfg->m_prg_hs_zero = n < 1 ? 1 : n;
> > +
> > +	/*
> > +	 * clk_zero: forumula from NXP BSP
> > +	 */
> > +	n = (34 * (dphy_opts->hs_clk_rate / 1000000) - 2500) / 1000;
> > +	cfg->mc_prg_hs_zero = n < 1 ? 1 : n;
> > +
> > +	/*
> > +	 * clk_trail, hs_trail: forumula from NXP BSP
> > +	 */
> > +	n = (103 * (dphy_opts->hs_clk_rate / 1000000) + 10000) /
> > 10000;
> > +	if (n > 15)
> > +		n = 15;
> > +	if (n < 1)
> > +		n = 1;
> > +	cfg->m_prg_hs_trail = n;
> > +	cfg->mc_prg_hs_trail = n;
> > +
> > +	/*
> > +	 * rxhs_settle: formula from NXP BSP
> > +	 */
> > +	if (dphy_opts->hs_clk_rate < MBPS(80))
> > +		cfg->rxhs_settle = 0x0d;
> > +	else if (dphy_opts->hs_clk_rate < MBPS(90))
> > +		cfg->rxhs_settle = 0x0c;
> > +	else if (dphy_opts->hs_clk_rate < MBPS(125))
> > +		cfg->rxhs_settle = 0x0b;
> > +	else if (dphy_opts->hs_clk_rate < MBPS(150))
> > +		cfg->rxhs_settle = 0x0a;
> > +	else if (dphy_opts->hs_clk_rate < MBPS(225))
> > +		cfg->rxhs_settle = 0x09;
> > +	else if (dphy_opts->hs_clk_rate < MBPS(500))
> > +		cfg->rxhs_settle = 0x08;
> > +	else
> > +		cfg->rxhs_settle = 0x07;
> > +
> > +	dev_dbg(&phy->dev, "hs_prepare: %u, clk_prepare: %u, "
> > +		"hs_prepare: %u, clk_prepare: %u, "
> > +		"hs_trail: %u, clk_trail: %u, "
> > +		"rxhs_settle: %u\n",
> > +		cfg->m_prg_hs_prepare, cfg->mc_prg_hs_prepare,
> > +		cfg->m_prg_hs_zero, cfg->mc_prg_hs_zero,
> > +		cfg->m_prg_hs_trail, cfg->mc_prg_hs_trail,
> > +		cfg->rxhs_settle);
> > +
> > +	return 0;
> > +}
> > +
> > +static void mixel_phy_set_hs_timings(struct phy *phy)
> > +{
> > +	struct mixel_dphy_priv *priv = phy_get_drvdata(phy);
> > +
> > +	phy_write(phy, priv->cfg.m_prg_hs_prepare,
> > DPHY_M_PRG_HS_PREPARE);
> > +	phy_write(phy, priv->cfg.mc_prg_hs_prepare,
> > DPHY_MC_PRG_HS_PREPARE);
> > +	phy_write(phy, priv->cfg.m_prg_hs_zero, DPHY_M_PRG_HS_ZERO);
> > +	phy_write(phy, priv->cfg.mc_prg_hs_zero,
> > DPHY_MC_PRG_HS_ZERO);
> > +	phy_write(phy, priv->cfg.m_prg_hs_trail,
> > DPHY_M_PRG_HS_TRAIL);
> > +	phy_write(phy, priv->cfg.mc_prg_hs_trail,
> > DPHY_MC_PRG_HS_TRAIL);
> > +	phy_write(phy, priv->cfg.rxhs_settle, priv->devdata-
> > >reg_rxhs_settle);
> > +}
> > +
> > +static int mixel_dphy_set_pll_params(struct phy *phy)
> > +{
> > +	struct mixel_dphy_priv *priv = dev_get_drvdata(phy-
> > >dev.parent);
> > +
> > +	if (priv->cfg.cm < 16 || priv->cfg.cm > 255 ||
> > +	    priv->cfg.cn < 1 || priv->cfg.cn > 32 ||
> > +	    priv->cfg.co < 1 || priv->cfg.co > 8) {
> > +		dev_err(&phy->dev, "Invalid CM/CN/CO values!
> > (%u/%u/%u)\n",
> > +			priv->cfg.cm, priv->cfg.cn, priv->cfg.co);
> > +		return -EINVAL;
> > +	}
> > +	dev_dbg(&phy->dev, "Using CM:%u CN:%u CO:%u\n",
> > +		priv->cfg.cm, priv->cfg.cn, priv->cfg.co);
> > +	phy_write(phy, CM(priv->cfg.cm), DPHY_CM);
> > +	phy_write(phy, CN(priv->cfg.cn), DPHY_CN);
> > +	phy_write(phy, CO(priv->cfg.co), DPHY_CO);
> > +	return 0;
> > +}
> > +
> > +static int mixel_dphy_configure(struct phy *phy, union
> > phy_configure_opts *opts)
> > +{
> > +	struct mixel_dphy_priv *priv = phy_get_drvdata(phy);
> > +	struct mixel_dphy_cfg cfg = { 0 };
> > +	int ret;
> > +
> > +	ret = mixel_dphy_config_from_opts(phy, &opts->mipi_dphy,
> > &cfg);
> > +	if (ret)
> > +		return ret;
> > +
> > +	/* Update the configuration */
> > +	memcpy(&priv->cfg, &cfg, sizeof(struct mixel_dphy_cfg));
> > +
> > +	dev_dbg(&phy->dev, "Using CM:%u CN:%u CO:%u\n",
> > +		priv->cfg.cm, priv->cfg.cn, priv->cfg.co);
> > +
> > +	phy_write(phy, 0x00, DPHY_LOCK_BYP);
> > +	phy_write(phy, 0x01, priv->devdata->reg_tx_rcal);
> > +	phy_write(phy, 0x00, priv->devdata->reg_auto_pd_en);
> > +	phy_write(phy, 0x02, priv->devdata->reg_rxlprp);
> > +	phy_write(phy, 0x02, priv->devdata->reg_rxcdrp);
> > +	phy_write(phy, 0x25, DPHY_TST);
> > +
> > +	mixel_phy_set_hs_timings(phy);
> > +	ret = mixel_dphy_set_pll_params(phy);
> > +	if (ret < 0)
> > +		return ret;
> > +
> > +	return 0;
> > +}
> > +
> > +static int mixel_dphy_validate(struct phy *phy, enum phy_mode mode,
> > int submode,
> > +			       union phy_configure_opts *opts)
> > +{
> > +	struct mixel_dphy_cfg cfg = { 0 };
> > +
> > +	if (mode != PHY_MODE_MIPI_DPHY)
> > +		return -EINVAL;
> > +
> > +	return mixel_dphy_config_from_opts(phy, &opts->mipi_dphy,
> > &cfg);
> > +}
> > +
> > +static int mixel_dphy_power_on(struct phy *phy)
> > +{
> > +	struct mixel_dphy_priv *priv = phy_get_drvdata(phy);
> > +	u32 locked;
> > +
> > +	clk_prepare_enable(priv->phy_ref_clk);
> > +
> > +	phy_write(phy, PWR_ON, DPHY_PD_DPHY);
> > +	phy_write(phy, PWR_ON, DPHY_PD_PLL);
> 
> According to the Mixel RM, the power on sequence is the following:
> 1. Deassert PD_PLL
> 2. Wait for DPHY_LOCK
> 3. Deassert PD_DPHY
> Therefore, the PD_DPHY deassertion should be moved after the read_poll
> 
> Another thing regarding the power-on sequence: PD_PLL and PD_DPHY
> states must be asserted before powering-on. In the NXP tree this was
> done in the init stage, but this stage is missing here. I think you
> could add this, or you could assert them (write PWR_OFF) in configure
> stage.

I've folded both of these in for v3. These things were done differently
in the NXP 4.9 driver where I picked that form, I also added an exit
function to reset CN/CM/CO as is done in NXPs 4.14 driver.
Thanks for having a look,
 -- Guido

> 
> > +
> > +	if (regmap_read_poll_timeout(priv->regs, DPHY_LOCK, locked,
> > +				     locked, 10, 1000) < 0) {
> > +		dev_err(&phy->dev, "Could not get DPHY lock!\n");
> > +		return -EINVAL;
> > +	}
> > +
> > +	return 0;
> > +}
> > +
> > +static int mixel_dphy_power_off(struct phy *phy)
> > +{
> > +	struct mixel_dphy_priv *priv = phy_get_drvdata(phy);
> > +
> > +	phy_write(phy, PWR_OFF, DPHY_PD_PLL);
> > +	phy_write(phy, PWR_OFF, DPHY_PD_DPHY);
> > +
> > +	clk_disable_unprepare(priv->phy_ref_clk);
> > +
> > +	return 0;
> > +}
> > +
> > +static const struct phy_ops mixel_dphy_phy_ops = {
> > +	.power_on = mixel_dphy_power_on,
> > +	.power_off = mixel_dphy_power_off,
> > +	.configure = mixel_dphy_configure,
> > +	.validate = mixel_dphy_validate,
> > +	.owner = THIS_MODULE,
> > +};
> > +
> > +static const struct of_device_id mixel_dphy_of_match[] = {
> > +	{ .compatible = "mixel,imx8mq-mipi-dphy",
> > +	  .data = &mixel_dphy_devdata[MIXEL_IMX8MQ] },
> > +	{ /* sentinel */ },
> > +};
> > +MODULE_DEVICE_TABLE(of, mixel_dphy_of_match);
> > +
> > +static int mixel_dphy_probe(struct platform_device *pdev)
> > +{
> > +	struct device *dev = &pdev->dev;
> > +	struct device_node *np = dev->of_node;
> > +	struct phy_provider *phy_provider;
> > +	struct mixel_dphy_priv *priv;
> > +	struct resource *res;
> > +	struct phy *phy;
> > +	void __iomem *regs;
> > +
> > +	if (!np)
> > +		return -ENODEV;
> > +
> > +	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
> > +	if (!priv)
> > +		return -ENOMEM;
> > +
> > +	priv->devdata = of_device_get_match_data(&pdev->dev);
> > +	if (!priv->devdata)
> > +		return -EINVAL;
> > +
> > +	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
> > +	if (!res)
> > +		return -ENODEV;
> > +
> > +	regs = devm_ioremap(dev, res->start, resource_size(res));
> > +	if (IS_ERR(priv->regs)) {
> > +		dev_err(dev, "Couldn't map the DPHY registers\n");
> > +		return PTR_ERR(priv->regs);
> > +	}
> > +
> > +	priv->regs = devm_regmap_init_mmio(&pdev->dev, regs,
> > +					   &mixel_dphy_regmap_config
> > );
> > +	if (IS_ERR(priv->regs)) {
> > +		dev_err(dev, "Couldn't create the DPHY regmap\n");
> > +		return PTR_ERR(priv->regs);
> > +	}
> > +
> > +	priv->phy_ref_clk = devm_clk_get(&pdev->dev, "phy_ref");
> > +	if (IS_ERR(priv->phy_ref_clk)) {
> > +		dev_err(dev, "No phy_ref clock found\n");
> > +		return PTR_ERR(priv->phy_ref_clk);
> > +	}
> > +	dev_dbg(dev, "phy_ref clock rate: %lu\n",
> > +		clk_get_rate(priv->phy_ref_clk));
> > +
> > +	dev_set_drvdata(dev, priv);
> > +
> > +	phy = devm_phy_create(dev, np, &mixel_dphy_phy_ops);
> > +	if (IS_ERR(phy)) {
> > +		dev_err(dev, "Failed to create phy %ld\n",
> > PTR_ERR(phy));
> > +		return PTR_ERR(phy);
> > +	}
> > +	phy_set_drvdata(phy, priv);
> > +
> > +	phy_provider = devm_of_phy_provider_register(dev,
> > of_phy_simple_xlate);
> > +
> > +	return PTR_ERR_OR_ZERO(phy_provider);
> > +}
> > +
> > +static struct platform_driver mixel_dphy_driver = {
> > +	.probe	= mixel_dphy_probe,
> > +	.driver = {
> > +		.name = "mixel-mipi-dphy",
> > +		.of_match_table	= mixel_dphy_of_match,
> > +	}
> > +};
> > +module_platform_driver(mixel_dphy_driver);
> > +
> > +MODULE_AUTHOR("NXP Semiconductor");
> > +MODULE_DESCRIPTION("Mixel MIPI-DSI PHY driver");
> > +MODULE_LICENSE("GPL v2");

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