| Message ID | 20230720-fpdlink-additions-v2-7-b91b1eca2ad3@ideasonboard.com (mailing list archive) |
|---|---|
| State | New, archived |
| Headers | show |
| Series | media: i2c: ds90ub9xx: Misc improvements | expand |
Hi Tomi, Thank you for the patch. On Thu, Jul 20, 2023 at 01:30:38PM +0300, Tomi Valkeinen wrote: > Add support for FPD-Link non-sync mode with external clock. The only > thing that needs to be added is the calculation for the clkout. > > Signed-off-by: Tomi Valkeinen <tomi.valkeinen@ideasonboard.com> > --- > drivers/media/i2c/ds90ub953.c | 34 ++++++++++++++++++++++++++-------- > 1 file changed, 26 insertions(+), 8 deletions(-) > > diff --git a/drivers/media/i2c/ds90ub953.c b/drivers/media/i2c/ds90ub953.c > index 3a19c6dedd2f..846542e6e20d 100644 > --- a/drivers/media/i2c/ds90ub953.c > +++ b/drivers/media/i2c/ds90ub953.c > @@ -143,6 +143,7 @@ struct ub953_data { > > struct i2c_client *client; > struct regmap *regmap; > + struct clk *clkin; > > u32 num_data_lanes; > bool non_cont_clk; > @@ -842,15 +843,21 @@ static int ub953_i2c_master_init(struct ub953_data *priv) > > static u64 ub953_get_fc_rate(struct ub953_data *priv) > { > - if (priv->mode != UB953_MODE_SYNC) { > + switch (priv->mode) { > + case UB953_MODE_SYNC: > + if (priv->hw_data->is_ub971) > + return priv->plat_data->bc_rate * 160ull; > + else > + return priv->plat_data->bc_rate / 2 * 160ull; > + > + case UB953_MODE_NONSYNC_EXT: > + /* CLKIN_DIV = 1 always */ > + return clk_get_rate(priv->clkin) * 80ull; > + > + default: > /* Not supported */ > return 0; > } > - > - if (priv->hw_data->is_ub971) > - return priv->plat_data->bc_rate * 160ull; > - else > - return priv->plat_data->bc_rate / 2 * 160ull; > } > > static unsigned long ub953_calc_clkout_ub953(struct ub953_data *priv, > @@ -1188,9 +1195,15 @@ static int ub953_hw_init(struct ub953_data *priv) > dev_dbg(dev, "mode from %s: %#x\n", mode_override ? "reg" : "strap", > priv->mode); > > - if (priv->mode != UB953_MODE_SYNC) > + if (priv->mode != UB953_MODE_SYNC && > + priv->mode != UB953_MODE_NONSYNC_EXT) > return dev_err_probe(dev, -ENODEV, > - "Only synchronous mode supported\n"); > + "Unsupported mode selected: %d\n", %u > + priv->mode); > + > + if (priv->mode == UB953_MODE_NONSYNC_EXT && !priv->clkin) > + return dev_err_probe(dev, -EINVAL, > + "clkin required for non-sync ext mode\n"); > > ret = ub953_read(priv, UB953_REG_REV_MASK_ID, &v); > if (ret) > @@ -1318,6 +1331,11 @@ static int ub953_probe(struct i2c_client *client) > goto err_mutex_destroy; > } > > + priv->clkin = devm_clk_get_optional(dev, "clkin"); > + if (IS_ERR(priv->clkin)) > + return dev_err_probe(dev, PTR_ERR(priv->clkin), > + "failed to parse 'clkin'\n"); You need to goto err_mutex_destroy. Reviewed-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> > + > ret = ub953_parse_dt(priv); > if (ret) > goto err_mutex_destroy; >
diff --git a/drivers/media/i2c/ds90ub953.c b/drivers/media/i2c/ds90ub953.c index 3a19c6dedd2f..846542e6e20d 100644 --- a/drivers/media/i2c/ds90ub953.c +++ b/drivers/media/i2c/ds90ub953.c @@ -143,6 +143,7 @@ struct ub953_data { struct i2c_client *client; struct regmap *regmap; + struct clk *clkin; u32 num_data_lanes; bool non_cont_clk; @@ -842,15 +843,21 @@ static int ub953_i2c_master_init(struct ub953_data *priv) static u64 ub953_get_fc_rate(struct ub953_data *priv) { - if (priv->mode != UB953_MODE_SYNC) { + switch (priv->mode) { + case UB953_MODE_SYNC: + if (priv->hw_data->is_ub971) + return priv->plat_data->bc_rate * 160ull; + else + return priv->plat_data->bc_rate / 2 * 160ull; + + case UB953_MODE_NONSYNC_EXT: + /* CLKIN_DIV = 1 always */ + return clk_get_rate(priv->clkin) * 80ull; + + default: /* Not supported */ return 0; } - - if (priv->hw_data->is_ub971) - return priv->plat_data->bc_rate * 160ull; - else - return priv->plat_data->bc_rate / 2 * 160ull; } static unsigned long ub953_calc_clkout_ub953(struct ub953_data *priv, @@ -1188,9 +1195,15 @@ static int ub953_hw_init(struct ub953_data *priv) dev_dbg(dev, "mode from %s: %#x\n", mode_override ? "reg" : "strap", priv->mode); - if (priv->mode != UB953_MODE_SYNC) + if (priv->mode != UB953_MODE_SYNC && + priv->mode != UB953_MODE_NONSYNC_EXT) return dev_err_probe(dev, -ENODEV, - "Only synchronous mode supported\n"); + "Unsupported mode selected: %d\n", + priv->mode); + + if (priv->mode == UB953_MODE_NONSYNC_EXT && !priv->clkin) + return dev_err_probe(dev, -EINVAL, + "clkin required for non-sync ext mode\n"); ret = ub953_read(priv, UB953_REG_REV_MASK_ID, &v); if (ret) @@ -1318,6 +1331,11 @@ static int ub953_probe(struct i2c_client *client) goto err_mutex_destroy; } + priv->clkin = devm_clk_get_optional(dev, "clkin"); + if (IS_ERR(priv->clkin)) + return dev_err_probe(dev, PTR_ERR(priv->clkin), + "failed to parse 'clkin'\n"); + ret = ub953_parse_dt(priv); if (ret) goto err_mutex_destroy;
Add support for FPD-Link non-sync mode with external clock. The only thing that needs to be added is the calculation for the clkout. Signed-off-by: Tomi Valkeinen <tomi.valkeinen@ideasonboard.com> --- drivers/media/i2c/ds90ub953.c | 34 ++++++++++++++++++++++++++-------- 1 file changed, 26 insertions(+), 8 deletions(-)