| Message ID | 20221219021820.24596-1-laurent.pinchart@ideasonboard.com (mailing list archive) |
|---|---|
| State | Mainlined |
| Commit | 817660f44d6063168ba27931e56c5cd2d5ae86af |
| Delegated to: | Kieran Bingham |
| Headers | show |
| Series | None | expand |
Hi Laurent On Mon, Dec 19, 2022 at 04:18:20AM +0200, Laurent Pinchart wrote: > From: Thomas Nizan <tnizan@witekio.com> > > Allow users to use one PoC regulator per port, instead of a global > regulator. > > The properties '^port[0-3]-poc-supply$' in the DT node are used to > indicate the regulators for individual ports. > > Signed-off-by: Thomas Nizan <tnizan@witekio.com> > Signed-off-by: Laurent Pinchart <laurent.pinchart+renesas@ideasonboard.com> Reviewed-by: Jacopo Mondi <jacopo.mondi@ideasonboard.com> > --- > Changes since v3: > > - Use dev_err_probe() everywhere > > Changes since v2: > > - Adapt to the poc-gpio support > > Changes since v1: > > - Use to_index() > - Use dev_err_probe() > - Fix error path in probe() > - Use devm_regulator_get_optional() instead of > devm_regulator_get_exclusive() > --- > drivers/media/i2c/max9286.c | 135 ++++++++++++++++++++++++++++++------ > 1 file changed, 112 insertions(+), 23 deletions(-) > > diff --git a/drivers/media/i2c/max9286.c b/drivers/media/i2c/max9286.c > index 9c083cf14231..a65457b1e7e0 100644 > --- a/drivers/media/i2c/max9286.c > +++ b/drivers/media/i2c/max9286.c > @@ -139,6 +139,7 @@ > struct max9286_source { > struct v4l2_subdev *sd; > struct fwnode_handle *fwnode; > + struct regulator *regulator; > }; > > struct max9286_asd { > @@ -169,6 +170,7 @@ struct max9286_priv { > u32 init_rev_chan_mv; > u32 rev_chan_mv; > > + bool use_gpio_poc; > u32 gpio_poc[2]; > > struct v4l2_ctrl_handler ctrls; > @@ -1088,9 +1090,6 @@ static int max9286_parse_gpios(struct max9286_priv *priv) > struct device *dev = &priv->client->dev; > int ret; > > - /* GPIO values default to high */ > - priv->gpio_state = BIT(0) | BIT(1); > - > /* > * Parse the "gpio-poc" vendor property. If the property is not > * specified the camera power is controlled by a regulator. > @@ -1102,18 +1101,7 @@ static int max9286_parse_gpios(struct max9286_priv *priv) > * If gpio lines are not used for the camera power, register > * a gpio controller for consumers. > */ > - ret = max9286_register_gpio(priv); > - if (ret) > - return ret; > - > - priv->regulator = devm_regulator_get(dev, "poc"); > - if (IS_ERR(priv->regulator)) { > - return dev_err_probe(dev, PTR_ERR(priv->regulator), > - "Unable to get PoC regulator (%ld)\n", > - PTR_ERR(priv->regulator)); > - } > - > - return 0; > + return max9286_register_gpio(priv); > } > > /* If the property is specified make sure it is well formed. */ > @@ -1124,21 +1112,75 @@ static int max9286_parse_gpios(struct max9286_priv *priv) > return -EINVAL; > } > > + priv->use_gpio_poc = true; > return 0; > } > > +static int max9286_poc_power_on(struct max9286_priv *priv) > +{ > + struct max9286_source *source; > + unsigned int enabled = 0; > + int ret; > + > + /* Enable the global regulator if available. */ > + if (priv->regulator) > + return regulator_enable(priv->regulator); > + > + if (priv->use_gpio_poc) > + return max9286_gpio_set(priv, priv->gpio_poc[0], > + !priv->gpio_poc[1]); > + > + /* Otherwise use the per-port regulators. */ > + for_each_source(priv, source) { > + ret = regulator_enable(source->regulator); > + if (ret < 0) > + goto error; > + > + enabled |= BIT(to_index(priv, source)); > + } > + > + return 0; > + > +error: > + for_each_source(priv, source) { > + if (enabled & BIT(to_index(priv, source))) > + regulator_disable(source->regulator); > + } > + > + return ret; > +} > + > +static int max9286_poc_power_off(struct max9286_priv *priv) > +{ > + struct max9286_source *source; > + int ret = 0; > + > + if (priv->regulator) > + return regulator_disable(priv->regulator); > + > + if (priv->use_gpio_poc) > + return max9286_gpio_set(priv, priv->gpio_poc[0], > + priv->gpio_poc[1]); > + > + for_each_source(priv, source) { > + int err; > + > + err = regulator_disable(source->regulator); > + if (!ret) > + ret = err; > + } > + > + return ret; > +} > + > static int max9286_poc_enable(struct max9286_priv *priv, bool enable) > { > int ret; > > - /* If the regulator is not available, use gpio to control power. */ > - if (!priv->regulator) > - ret = max9286_gpio_set(priv, priv->gpio_poc[0], > - enable ^ priv->gpio_poc[1]); > - else if (enable) > - ret = regulator_enable(priv->regulator); > + if (enable) > + ret = max9286_poc_power_on(priv); > else > - ret = regulator_disable(priv->regulator); > + ret = max9286_poc_power_off(priv); > > if (ret < 0) > dev_err(&priv->client->dev, "Unable to turn power %s\n", > @@ -1317,6 +1359,44 @@ static int max9286_parse_dt(struct max9286_priv *priv) > return 0; > } > > +static int max9286_get_poc_supplies(struct max9286_priv *priv) > +{ > + struct device *dev = &priv->client->dev; > + struct max9286_source *source; > + int ret; > + > + /* Start by getting the global regulator. */ > + priv->regulator = devm_regulator_get_optional(dev, "poc"); > + if (!IS_ERR(priv->regulator)) > + return 0; > + > + if (PTR_ERR(priv->regulator) != -ENODEV) > + return dev_err_probe(dev, PTR_ERR(priv->regulator), > + "Unable to get PoC regulator\n"); > + > + /* If there's no global regulator, get per-port regulators. */ > + dev_dbg(dev, > + "No global PoC regulator, looking for per-port regulators\n"); > + priv->regulator = NULL; > + > + for_each_source(priv, source) { > + unsigned int index = to_index(priv, source); > + char name[10]; > + > + snprintf(name, sizeof(name), "port%u-poc", index); > + source->regulator = devm_regulator_get(dev, name); > + if (IS_ERR(source->regulator)) { > + ret = PTR_ERR(source->regulator); > + dev_err_probe(dev, ret, > + "Unable to get port %u PoC regulator\n", > + index); > + return ret; > + } > + } > + > + return 0; > +} > + > static int max9286_probe(struct i2c_client *client) > { > struct max9286_priv *priv; > @@ -1330,6 +1410,9 @@ static int max9286_probe(struct i2c_client *client) > > priv->client = client; > > + /* GPIO values default to high */ > + priv->gpio_state = BIT(0) | BIT(1); > + > priv->gpiod_pwdn = devm_gpiod_get_optional(&client->dev, "enable", > GPIOD_OUT_HIGH); > if (IS_ERR(priv->gpiod_pwdn)) > @@ -1362,7 +1445,13 @@ static int max9286_probe(struct i2c_client *client) > > ret = max9286_parse_dt(priv); > if (ret) > - goto err_powerdown; > + goto err_cleanup_dt; > + > + if (!priv->use_gpio_poc) { > + ret = max9286_get_poc_supplies(priv); > + if (ret) > + goto err_cleanup_dt; > + } > > ret = max9286_init(priv); > if (ret < 0) > -- > Regards, > > Laurent Pinchart >
diff --git a/drivers/media/i2c/max9286.c b/drivers/media/i2c/max9286.c index 9c083cf14231..a65457b1e7e0 100644 --- a/drivers/media/i2c/max9286.c +++ b/drivers/media/i2c/max9286.c @@ -139,6 +139,7 @@ struct max9286_source { struct v4l2_subdev *sd; struct fwnode_handle *fwnode; + struct regulator *regulator; }; struct max9286_asd { @@ -169,6 +170,7 @@ struct max9286_priv { u32 init_rev_chan_mv; u32 rev_chan_mv; + bool use_gpio_poc; u32 gpio_poc[2]; struct v4l2_ctrl_handler ctrls; @@ -1088,9 +1090,6 @@ static int max9286_parse_gpios(struct max9286_priv *priv) struct device *dev = &priv->client->dev; int ret; - /* GPIO values default to high */ - priv->gpio_state = BIT(0) | BIT(1); - /* * Parse the "gpio-poc" vendor property. If the property is not * specified the camera power is controlled by a regulator. @@ -1102,18 +1101,7 @@ static int max9286_parse_gpios(struct max9286_priv *priv) * If gpio lines are not used for the camera power, register * a gpio controller for consumers. */ - ret = max9286_register_gpio(priv); - if (ret) - return ret; - - priv->regulator = devm_regulator_get(dev, "poc"); - if (IS_ERR(priv->regulator)) { - return dev_err_probe(dev, PTR_ERR(priv->regulator), - "Unable to get PoC regulator (%ld)\n", - PTR_ERR(priv->regulator)); - } - - return 0; + return max9286_register_gpio(priv); } /* If the property is specified make sure it is well formed. */ @@ -1124,21 +1112,75 @@ static int max9286_parse_gpios(struct max9286_priv *priv) return -EINVAL; } + priv->use_gpio_poc = true; return 0; } +static int max9286_poc_power_on(struct max9286_priv *priv) +{ + struct max9286_source *source; + unsigned int enabled = 0; + int ret; + + /* Enable the global regulator if available. */ + if (priv->regulator) + return regulator_enable(priv->regulator); + + if (priv->use_gpio_poc) + return max9286_gpio_set(priv, priv->gpio_poc[0], + !priv->gpio_poc[1]); + + /* Otherwise use the per-port regulators. */ + for_each_source(priv, source) { + ret = regulator_enable(source->regulator); + if (ret < 0) + goto error; + + enabled |= BIT(to_index(priv, source)); + } + + return 0; + +error: + for_each_source(priv, source) { + if (enabled & BIT(to_index(priv, source))) + regulator_disable(source->regulator); + } + + return ret; +} + +static int max9286_poc_power_off(struct max9286_priv *priv) +{ + struct max9286_source *source; + int ret = 0; + + if (priv->regulator) + return regulator_disable(priv->regulator); + + if (priv->use_gpio_poc) + return max9286_gpio_set(priv, priv->gpio_poc[0], + priv->gpio_poc[1]); + + for_each_source(priv, source) { + int err; + + err = regulator_disable(source->regulator); + if (!ret) + ret = err; + } + + return ret; +} + static int max9286_poc_enable(struct max9286_priv *priv, bool enable) { int ret; - /* If the regulator is not available, use gpio to control power. */ - if (!priv->regulator) - ret = max9286_gpio_set(priv, priv->gpio_poc[0], - enable ^ priv->gpio_poc[1]); - else if (enable) - ret = regulator_enable(priv->regulator); + if (enable) + ret = max9286_poc_power_on(priv); else - ret = regulator_disable(priv->regulator); + ret = max9286_poc_power_off(priv); if (ret < 0) dev_err(&priv->client->dev, "Unable to turn power %s\n", @@ -1317,6 +1359,44 @@ static int max9286_parse_dt(struct max9286_priv *priv) return 0; } +static int max9286_get_poc_supplies(struct max9286_priv *priv) +{ + struct device *dev = &priv->client->dev; + struct max9286_source *source; + int ret; + + /* Start by getting the global regulator. */ + priv->regulator = devm_regulator_get_optional(dev, "poc"); + if (!IS_ERR(priv->regulator)) + return 0; + + if (PTR_ERR(priv->regulator) != -ENODEV) + return dev_err_probe(dev, PTR_ERR(priv->regulator), + "Unable to get PoC regulator\n"); + + /* If there's no global regulator, get per-port regulators. */ + dev_dbg(dev, + "No global PoC regulator, looking for per-port regulators\n"); + priv->regulator = NULL; + + for_each_source(priv, source) { + unsigned int index = to_index(priv, source); + char name[10]; + + snprintf(name, sizeof(name), "port%u-poc", index); + source->regulator = devm_regulator_get(dev, name); + if (IS_ERR(source->regulator)) { + ret = PTR_ERR(source->regulator); + dev_err_probe(dev, ret, + "Unable to get port %u PoC regulator\n", + index); + return ret; + } + } + + return 0; +} + static int max9286_probe(struct i2c_client *client) { struct max9286_priv *priv; @@ -1330,6 +1410,9 @@ static int max9286_probe(struct i2c_client *client) priv->client = client; + /* GPIO values default to high */ + priv->gpio_state = BIT(0) | BIT(1); + priv->gpiod_pwdn = devm_gpiod_get_optional(&client->dev, "enable", GPIOD_OUT_HIGH); if (IS_ERR(priv->gpiod_pwdn)) @@ -1362,7 +1445,13 @@ static int max9286_probe(struct i2c_client *client) ret = max9286_parse_dt(priv); if (ret) - goto err_powerdown; + goto err_cleanup_dt; + + if (!priv->use_gpio_poc) { + ret = max9286_get_poc_supplies(priv); + if (ret) + goto err_cleanup_dt; + } ret = max9286_init(priv); if (ret < 0)