Hi Guido

On Vi, 2019-02-08 at 12:40 +0100, Guido Günther wrote:
> 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?

That's OK, I guess. Regarding the manuals: we have them from the vendor
so I can't share 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.

Eventually I got it working. On i.MX8MQ there is a System Reset
Controller that controls the clocks on each individual block. For some
reason, before asserting the MIPI clock domain in this SRC, a delay is
needed (right now, the hack is a sleep). Probably there is a component
that is not ready yet. Right now I am trying to figure out which one is
it and how can I wait for it.

> 
> > 
> > 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.

Good to know. Currently I am working on the eLCDIF pipeline on 850D to
make it ready for upstream. Since you took my DPHY driver and submitted
upstream in a better shape, I will make use of it.

> 
> > 
> > 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 <a...@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_co
> > > nfig
> > > );
> > > + 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");
_______________________________________________
dri-devel mailing list
dri-devel@lists.freedesktop.org
https://lists.freedesktop.org/mailman/listinfo/dri-devel

Reply via email to