Current design only allows TCPM to get the Sink VDO from TCPC configs.
Add an additional way from fwnode.

Signed-off-by: Kyle Tso <kyle...@google.com>
---
 drivers/usb/typec/tcpm/tcpm.c | 12 ++++++++++++
 1 file changed, 12 insertions(+)

diff --git a/drivers/usb/typec/tcpm/tcpm.c b/drivers/usb/typec/tcpm/tcpm.c
index c14cf7842520..7b797d14d9db 100644
--- a/drivers/usb/typec/tcpm/tcpm.c
+++ b/drivers/usb/typec/tcpm/tcpm.c
@@ -5673,6 +5673,18 @@ static int tcpm_fw_get_caps(struct tcpm_port *port,
                        port->new_source_frs_current = frs_current;
        }
 
+       ret = fwnode_property_read_u32_array(fwnode, "sink-vdos", NULL, 0);
+       if (ret <= 0 && ret != -EINVAL) {
+               return -EINVAL;
+       } else if (ret > 0) {
+               port->nr_snk_vdo = min(ret, VDO_MAX_OBJECTS);
+               ret = fwnode_property_read_u32_array(fwnode, "sink-vdos",
+                                                    port->snk_vdo,
+                                                    port->nr_snk_vdo);
+               if (ret < 0)
+                       return -EINVAL;
+       }
+
        return 0;
 }
 
-- 
2.30.0.280.ga3ce27912f-goog

Reply via email to