platform/chrome: cros_ec_sensorhub: Retries when a sensor is not ready

When the EC/ISH starts, it can take a while for all the sensors to be up
and running or declared broken.

If the sensor stack return -EBUSY when checking for sensor information,
retry up to 50 times.
It has been observed 100ms wait time is enough to have valid sensors
ready. It can take more time in case a sensor is really broken and is
not coming up.

Signed-off-by: Gwendal Grignou <gwendal@google.com>
Link: https://lore.kernel.org/r/20250623210518.306740-1-gwendal@google.com
Signed-off-by: Tzung-Bi Shih <tzungbi@kernel.org>

diff --git a/drivers/platform/chrome/cros_ec_sensorhub.c b/drivers/platform/chrome/cros_ec_sensorhub.c
index 50cdae67fa3204f61649c3cf733d81ad4f3ad428..9bad8f72680ea81031838247a2b065fe8e7981d3 100644 (file)
--- a/drivers/platform/chrome/cros_ec_sensorhub.c
+++ b/drivers/platform/chrome/cros_ec_sensorhub.c
@@ -8,6 +8,7 @@
 
 #include <linux/init.h>
 #include <linux/device.h>
+#include <linux/delay.h>
 #include <linux/mod_devicetable.h>
 #include <linux/module.h>
 #include <linux/platform_data/cros_ec_commands.h>
@@ -18,6 +19,7 @@
 #include <linux/types.h>
 
 #define DRV_NAME               "cros-ec-sensorhub"
+#define CROS_EC_CMD_INFO_RETRIES 50
 
 static void cros_ec_sensorhub_free_sensor(void *arg)
 {
@@ -53,7 +55,7 @@ static int cros_ec_sensorhub_register(struct device *dev,
        int sensor_type[MOTIONSENSE_TYPE_MAX] = { 0 };
        struct cros_ec_command *msg = sensorhub->msg;
        struct cros_ec_dev *ec = sensorhub->ec;
-       int ret, i;
+       int ret, i, retries;
        char *name;
 
 
@@ -65,12 +67,25 @@ static int cros_ec_sensorhub_register(struct device *dev,
                sensorhub->params->cmd = MOTIONSENSE_CMD_INFO;
                sensorhub->params->info.sensor_num = i;
 
-               ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);
+               retries = CROS_EC_CMD_INFO_RETRIES;
+               do {
+                       ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);
+                       if (ret == -EBUSY) {
+                               /* The EC is still busy initializing sensors. */
+                               usleep_range(5000, 6000);
+                               retries--;
+                       }
+               } while (ret == -EBUSY && retries);
+
                if (ret < 0) {
-                       dev_warn(dev, "no info for EC sensor %d : %d/%d\n",
-                                i, ret, msg->result);
+                       dev_err(dev, "no info for EC sensor %d : %d/%d\n",
+                               i, ret, msg->result);
                        continue;
                }
+               if (retries < CROS_EC_CMD_INFO_RETRIES) {
+                       dev_warn(dev, "%d retries needed to bring up sensor %d\n",
+                                CROS_EC_CMD_INFO_RETRIES - retries, i);
+               }
 
                switch (sensorhub->resp->info.type) {
                case MOTIONSENSE_TYPE_ACCEL: