2021-05-27 07:46:37

by [email protected]

[permalink] [raw]
Subject: [PATCH] soc: rockchip: io-domain: add rk3568 support

The io-domain registers on RK3568 SoCs have three separated bits to
enable/disable the 1.8v/2.5v/3.3v power.

This patch make the write to be a operation, allow rk3568 uses a private
register set function.

Since the 2.5v is not used on RK3568, so the driver only set
1.8v [enable] + 3.3v [disable] for 1.8v mode
1.8v [disable] + 3.3v [enable] for 3.3v mode

There is not register order requirement which has been cleared by our IC
team.

Signed-off-by: Jianqun Xu <[email protected]>
---
drivers/soc/rockchip/io-domain.c | 75 +++++++++++++++++++++++++++++++-
1 file changed, 73 insertions(+), 2 deletions(-)

diff --git a/drivers/soc/rockchip/io-domain.c b/drivers/soc/rockchip/io-domain.c
index cf8182fc3642..32b3bd645d56 100644
--- a/drivers/soc/rockchip/io-domain.c
+++ b/drivers/soc/rockchip/io-domain.c
@@ -51,6 +51,10 @@
#define RK3399_PMUGRF_CON0_VSEL BIT(8)
#define RK3399_PMUGRF_VSEL_SUPPLY_NUM 9

+#define RK3568_PMU_GRF_IO_VSEL0 (0x0140)
+#define RK3568_PMU_GRF_IO_VSEL1 (0x0144)
+#define RK3568_PMU_GRF_IO_VSEL2 (0x0148)
+
struct rockchip_iodomain;

struct rockchip_iodomain_soc_data {
@@ -71,8 +75,51 @@ struct rockchip_iodomain {
struct regmap *grf;
const struct rockchip_iodomain_soc_data *soc_data;
struct rockchip_iodomain_supply supplies[MAX_SUPPLIES];
+ int (*write)(struct rockchip_iodomain_supply *supply, int uV);
};

+static int rk3568_pmu_iodomain_write(struct rockchip_iodomain_supply *supply,
+ int uV)
+{
+ struct rockchip_iodomain *iod = supply->iod;
+ u32 is_3v3 = uV > MAX_VOLTAGE_1_8;
+ u32 val0, val1;
+ int b;
+
+ switch (supply->idx) {
+ case 0: /* pmuio1 */
+ break;
+ case 1: /* pmuio2 */
+ b = supply->idx;
+ val0 = BIT(16 + b) | (is_3v3 ? 0 : BIT(b));
+ b = supply->idx + 4;
+ val1 = BIT(16 + b) | (is_3v3 ? BIT(b) : 0);
+
+ regmap_write(iod->grf, RK3568_PMU_GRF_IO_VSEL2, val0);
+ regmap_write(iod->grf, RK3568_PMU_GRF_IO_VSEL2, val1);
+ break;
+ case 3: /* vccio2 */
+ break;
+ case 2: /* vccio1 */
+ case 4: /* vccio3 */
+ case 5: /* vccio4 */
+ case 6: /* vccio5 */
+ case 7: /* vccio6 */
+ case 8: /* vccio7 */
+ b = supply->idx - 1;
+ val0 = BIT(16 + b) | (is_3v3 ? 0 : BIT(b));
+ val1 = BIT(16 + b) | (is_3v3 ? BIT(b) : 0);
+
+ regmap_write(iod->grf, RK3568_PMU_GRF_IO_VSEL0, val0);
+ regmap_write(iod->grf, RK3568_PMU_GRF_IO_VSEL1, val1);
+ break;
+ default:
+ return -EINVAL;
+ };
+
+ return 0;
+}
+
static int rockchip_iodomain_write(struct rockchip_iodomain_supply *supply,
int uV)
{
@@ -136,7 +183,7 @@ static int rockchip_iodomain_notify(struct notifier_block *nb,
return NOTIFY_BAD;
}

- ret = rockchip_iodomain_write(supply, uV);
+ ret = supply->iod->write(supply, uV);
if (ret && event == REGULATOR_EVENT_PRE_VOLTAGE_CHANGE)
return NOTIFY_BAD;

@@ -398,6 +445,21 @@ static const struct rockchip_iodomain_soc_data soc_data_rk3399_pmu = {
.init = rk3399_pmu_iodomain_init,
};

+static const struct rockchip_iodomain_soc_data soc_data_rk3568_pmu = {
+ .grf_offset = 0x140,
+ .supply_names = {
+ "pmuio1",
+ "pmuio2",
+ "vccio1",
+ "vccio2",
+ "vccio3",
+ "vccio4",
+ "vccio5",
+ "vccio6",
+ "vccio7",
+ },
+};
+
static const struct rockchip_iodomain_soc_data soc_data_rv1108 = {
.grf_offset = 0x404,
.supply_names = {
@@ -469,6 +531,10 @@ static const struct of_device_id rockchip_iodomain_match[] = {
.compatible = "rockchip,rk3399-pmu-io-voltage-domain",
.data = &soc_data_rk3399_pmu
},
+ {
+ .compatible = "rockchip,rk3568-pmu-io-voltage-domain",
+ .data = &soc_data_rk3568_pmu
+ },
{
.compatible = "rockchip,rv1108-io-voltage-domain",
.data = &soc_data_rv1108
@@ -502,6 +568,11 @@ static int rockchip_iodomain_probe(struct platform_device *pdev)
match = of_match_node(rockchip_iodomain_match, np);
iod->soc_data = match->data;

+ if (match->data == &soc_data_rk3568_pmu)
+ iod->write = rk3568_pmu_iodomain_write;
+ else
+ iod->write = rockchip_iodomain_write;
+
parent = pdev->dev.parent;
if (parent && parent->of_node) {
iod->grf = syscon_node_to_regmap(parent->of_node);
@@ -562,7 +633,7 @@ static int rockchip_iodomain_probe(struct platform_device *pdev)
supply->reg = reg;
supply->nb.notifier_call = rockchip_iodomain_notify;

- ret = rockchip_iodomain_write(supply, uV);
+ ret = iod->write(supply, uV);
if (ret) {
supply->reg = NULL;
goto unreg_notify;
--
2.25.1




2021-05-27 07:48:52

by Heiko Stübner

[permalink] [raw]
Subject: Re: [PATCH] soc: rockchip: io-domain: add rk3568 support

Hi Jay,

Am Donnerstag, 27. Mai 2021, 09:29:17 CEST schrieb Jianqun Xu:
> The io-domain registers on RK3568 SoCs have three separated bits to
> enable/disable the 1.8v/2.5v/3.3v power.
>
> This patch make the write to be a operation, allow rk3568 uses a private
> register set function.
>
> Since the 2.5v is not used on RK3568, so the driver only set
> 1.8v [enable] + 3.3v [disable] for 1.8v mode
> 1.8v [disable] + 3.3v [enable] for 3.3v mode
>
> There is not register order requirement which has been cleared by our IC
> team.
>
> Signed-off-by: Jianqun Xu <[email protected]>

can you add a separate patch that adds the necessary compatible to the
dt-binding please?

One more thing below.

> ---
> drivers/soc/rockchip/io-domain.c | 75 +++++++++++++++++++++++++++++++-
> 1 file changed, 73 insertions(+), 2 deletions(-)
>
> diff --git a/drivers/soc/rockchip/io-domain.c b/drivers/soc/rockchip/io-domain.c
> index cf8182fc3642..32b3bd645d56 100644
> --- a/drivers/soc/rockchip/io-domain.c
> +++ b/drivers/soc/rockchip/io-domain.c
> @@ -51,6 +51,10 @@
> #define RK3399_PMUGRF_CON0_VSEL BIT(8)
> #define RK3399_PMUGRF_VSEL_SUPPLY_NUM 9
>
> +#define RK3568_PMU_GRF_IO_VSEL0 (0x0140)
> +#define RK3568_PMU_GRF_IO_VSEL1 (0x0144)
> +#define RK3568_PMU_GRF_IO_VSEL2 (0x0148)
> +
> struct rockchip_iodomain;
>
> struct rockchip_iodomain_soc_data {
> @@ -71,8 +75,51 @@ struct rockchip_iodomain {
> struct regmap *grf;
> const struct rockchip_iodomain_soc_data *soc_data;
> struct rockchip_iodomain_supply supplies[MAX_SUPPLIES];
> + int (*write)(struct rockchip_iodomain_supply *supply, int uV);
> };
>
> +static int rk3568_pmu_iodomain_write(struct rockchip_iodomain_supply *supply,
> + int uV)
> +{
> + struct rockchip_iodomain *iod = supply->iod;
> + u32 is_3v3 = uV > MAX_VOLTAGE_1_8;
> + u32 val0, val1;
> + int b;
> +
> + switch (supply->idx) {
> + case 0: /* pmuio1 */
> + break;
> + case 1: /* pmuio2 */
> + b = supply->idx;
> + val0 = BIT(16 + b) | (is_3v3 ? 0 : BIT(b));
> + b = supply->idx + 4;
> + val1 = BIT(16 + b) | (is_3v3 ? BIT(b) : 0);
> +
> + regmap_write(iod->grf, RK3568_PMU_GRF_IO_VSEL2, val0);
> + regmap_write(iod->grf, RK3568_PMU_GRF_IO_VSEL2, val1);
> + break;
> + case 3: /* vccio2 */
> + break;
> + case 2: /* vccio1 */
> + case 4: /* vccio3 */
> + case 5: /* vccio4 */
> + case 6: /* vccio5 */
> + case 7: /* vccio6 */
> + case 8: /* vccio7 */
> + b = supply->idx - 1;
> + val0 = BIT(16 + b) | (is_3v3 ? 0 : BIT(b));
> + val1 = BIT(16 + b) | (is_3v3 ? BIT(b) : 0);
> +
> + regmap_write(iod->grf, RK3568_PMU_GRF_IO_VSEL0, val0);
> + regmap_write(iod->grf, RK3568_PMU_GRF_IO_VSEL1, val1);
> + break;
> + default:
> + return -EINVAL;
> + };
> +
> + return 0;
> +}
> +
> static int rockchip_iodomain_write(struct rockchip_iodomain_supply *supply,
> int uV)
> {
> @@ -136,7 +183,7 @@ static int rockchip_iodomain_notify(struct notifier_block *nb,
> return NOTIFY_BAD;
> }
>
> - ret = rockchip_iodomain_write(supply, uV);
> + ret = supply->iod->write(supply, uV);
> if (ret && event == REGULATOR_EVENT_PRE_VOLTAGE_CHANGE)
> return NOTIFY_BAD;
>
> @@ -398,6 +445,21 @@ static const struct rockchip_iodomain_soc_data soc_data_rk3399_pmu = {
> .init = rk3399_pmu_iodomain_init,
> };
>
> +static const struct rockchip_iodomain_soc_data soc_data_rk3568_pmu = {
> + .grf_offset = 0x140,
> + .supply_names = {
> + "pmuio1",
> + "pmuio2",
> + "vccio1",
> + "vccio2",
> + "vccio3",
> + "vccio4",
> + "vccio5",
> + "vccio6",
> + "vccio7",
> + },

+ .write = rk3568_iodomain_write,

> +};
> +
> static const struct rockchip_iodomain_soc_data soc_data_rv1108 = {
> .grf_offset = 0x404,
> .supply_names = {
> @@ -469,6 +531,10 @@ static const struct of_device_id rockchip_iodomain_match[] = {
> .compatible = "rockchip,rk3399-pmu-io-voltage-domain",
> .data = &soc_data_rk3399_pmu
> },
> + {
> + .compatible = "rockchip,rk3568-pmu-io-voltage-domain",
> + .data = &soc_data_rk3568_pmu
> + },
> {
> .compatible = "rockchip,rv1108-io-voltage-domain",
> .data = &soc_data_rv1108
> @@ -502,6 +568,11 @@ static int rockchip_iodomain_probe(struct platform_device *pdev)
> match = of_match_node(rockchip_iodomain_match, np);
> iod->soc_data = match->data;
>
> + if (match->data == &soc_data_rk3568_pmu)
> + iod->write = rk3568_pmu_iodomain_write;
> + else
> + iod->write = rockchip_iodomain_write;
> +

So, please make the write callback part of the rockchip_iodomain_soc_data
struct. That way we don't need to compare for individual soc-types,
especially if later socs need a different approach again.

if (match->data->write)
iod->ops = match->data->write;
else
iod->ops = rockchip_iodomain_write;

Thanks
Heiko

> parent = pdev->dev.parent;
> if (parent && parent->of_node) {
> iod->grf = syscon_node_to_regmap(parent->of_node);
> @@ -562,7 +633,7 @@ static int rockchip_iodomain_probe(struct platform_device *pdev)
> supply->reg = reg;
> supply->nb.notifier_call = rockchip_iodomain_notify;
>
> - ret = rockchip_iodomain_write(supply, uV);
> + ret = iod->write(supply, uV);
> if (ret) {
> supply->reg = NULL;
> goto unreg_notify;
>