Register DPLL sub-devices to expose this functionality provided
by ZL3073x chip family. Each sub-device represents one of the provided
DPLL channels.

Signed-off-by: Ivan Vecera <[email protected]>
---
 drivers/mfd/zl3073x-core.c | 15 +++++++++++++++
 1 file changed, 15 insertions(+)

diff --git a/drivers/mfd/zl3073x-core.c b/drivers/mfd/zl3073x-core.c
index 0bd31591245a2..fda77724a8452 100644
--- a/drivers/mfd/zl3073x-core.c
+++ b/drivers/mfd/zl3073x-core.c
@@ -6,6 +6,7 @@
 #include <linux/device.h>
 #include <linux/export.h>
 #include <linux/math64.h>
+#include <linux/mfd/core.h>
 #include <linux/mfd/zl3073x.h>
 #include <linux/mfd/zl3073x_regs.h>
 #include <linux/module.h>
@@ -774,6 +775,20 @@ int zl3073x_dev_probe(struct zl3073x_dev *zldev,
        if (rc)
                return rc;
 
+       /* Add DPLL sub-device cell for each DPLL channel */
+       for (i = 0; i < chip_info->num_channels; i++) {
+               struct mfd_cell dpll_dev = MFD_CELL_BASIC("zl3073x-dpll", NULL,
+                                                         NULL, 0, i);
+
+               rc = devm_mfd_add_devices(zldev->dev, PLATFORM_DEVID_AUTO,
+                                         &dpll_dev, 1, NULL, 0, NULL);
+               if (rc) {
+                       dev_err_probe(zldev->dev, rc,
+                                     "Failed to add DPLL sub-device\n");
+                       return rc;
+               }
+       }
+
        /* Register the device as devlink device */
        devlink = priv_to_devlink(zldev);
        devlink_register(devlink);
-- 
2.48.1


Reply via email to