media: smiapp: Rely on runtime PM

Instead of relying on a mix of runtime PM and the s_power() callback, drop
the s_power() callback altogether and use runtime PM solely.

As device access is required during device power-on and power-off
sequences, runtime PM alone cannot tell whether the device is available.
Thus the "active" field is introduced in struct smiapp_sensor to tell
whether it is safe to write to the device.

Consequently there is no need to power on the device whenever a file
handle is open. This functionality is removed as well. The user may still
control the device power management through sysfs. Autosuspend remains
enabled, with 1 s delay.

Signed-off-by: Sakari Ailus <sakari.ailus@linux.intel.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@osg.samsung.com>

diff --git a/drivers/media/i2c/smiapp/smiapp-core.c b/drivers/media/i2c/smiapp/smiapp-core.c
index 8de444080b8f4868533ea8e68a0d26dc19c0f93b..faf567569799c7140664aa4de614c19a48d7e716 100644 (file)
--- a/drivers/media/i2c/smiapp/smiapp-core.c
+++ b/drivers/media/i2c/smiapp/smiapp-core.c
@@ -1239,6 +1239,10 @@ static int smiapp_power_on(struct device *dev)
        sleep = SMIAPP_RESET_DELAY(sensor->hwcfg->ext_clk);
        usleep_range(sleep, sleep);
 
+       mutex_lock(&sensor->mutex);
+
+       sensor->active = true;
+
        /*
         * Failures to respond to the address change command have been noticed.
         * Those failures seem to be caused by the sensor requiring a longer
@@ -1321,32 +1325,28 @@ static int smiapp_power_on(struct device *dev)
                goto out_cci_addr_fail;
        }
 
-       /* Are we still initialising...? If yes, return here. */
-       if (!sensor->pixel_array)
-               return 0;
-
-       mutex_lock(&sensor->mutex);
-
-       rval = __v4l2_ctrl_handler_setup(&sensor->pixel_array->ctrl_handler);
-       if (rval)
-               goto out_unlock;
+       /* Are we still initialising...? If not, proceed with control setup. */
+       if (sensor->pixel_array) {
+               rval = __v4l2_ctrl_handler_setup(
+                       &sensor->pixel_array->ctrl_handler);
+               if (rval)
+                       goto out_cci_addr_fail;
 
-       rval = __v4l2_ctrl_handler_setup(&sensor->src->ctrl_handler);
-       if (rval)
-               goto out_unlock;
+               rval = __v4l2_ctrl_handler_setup(&sensor->src->ctrl_handler);
+               if (rval)
+                       goto out_cci_addr_fail;
 
-       rval = smiapp_update_mode(sensor);
-       if (rval < 0)
-               goto out_unlock;
+               rval = smiapp_update_mode(sensor);
+               if (rval < 0)
+                       goto out_cci_addr_fail;
+       }
 
        mutex_unlock(&sensor->mutex);
 
        return 0;
 
-out_unlock:
-       mutex_unlock(&sensor->mutex);
-
 out_cci_addr_fail:
+       mutex_unlock(&sensor->mutex);
        gpiod_set_value(sensor->xshutdown, 0);
        clk_disable_unprepare(sensor->ext_clk);
 
@@ -1364,6 +1364,8 @@ static int smiapp_power_off(struct device *dev)
        struct smiapp_sensor *sensor =
                container_of(ssd, struct smiapp_sensor, ssds[0]);
 
+       mutex_lock(&sensor->mutex);
+
        /*
         * Currently power/clock to lens are enable/disabled separately
         * but they are essentially the same signals. So if the sensor is
@@ -1376,6 +1378,10 @@ static int smiapp_power_off(struct device *dev)
                             SMIAPP_REG_U8_SOFTWARE_RESET,
                             SMIAPP_SOFTWARE_RESET);
 
+       sensor->active = false;
+
+       mutex_unlock(&sensor->mutex);
+
        gpiod_set_value(sensor->xshutdown, 0);
        clk_disable_unprepare(sensor->ext_clk);
        usleep_range(5000, 5000);
@@ -1385,29 +1391,6 @@ static int smiapp_power_off(struct device *dev)
        return 0;
 }
 
-static int smiapp_set_power(struct v4l2_subdev *subdev, int on)
-{
-       int rval;
-
-       if (!on) {
-               pm_runtime_mark_last_busy(subdev->dev);
-               pm_runtime_put_autosuspend(subdev->dev);
-
-               return 0;
-       }
-
-       rval = pm_runtime_get_sync(subdev->dev);
-       if (rval >= 0)
-               return 0;
-
-       if (rval != -EBUSY && rval != -EAGAIN)
-               pm_runtime_set_active(subdev->dev);
-
-       pm_runtime_put(subdev->dev);
-
-       return rval;
-}
-
 /* -----------------------------------------------------------------------------
  * Video stream management
  */
@@ -1564,19 +1547,31 @@ out:
 static int smiapp_set_stream(struct v4l2_subdev *subdev, int enable)
 {
        struct smiapp_sensor *sensor = to_smiapp_sensor(subdev);
+       struct i2c_client *client = v4l2_get_subdevdata(&sensor->src->sd);
        int rval;
 
        if (sensor->streaming == enable)
                return 0;
 
        if (enable) {
+               rval = pm_runtime_get_sync(&client->dev);
+               if (rval < 0) {
+                       if (rval != -EBUSY && rval != -EAGAIN)
+                               pm_runtime_set_active(&client->dev);
+                       pm_runtime_put(&client->dev);
+                       return rval;
+               }
+
                sensor->streaming = true;
+
                rval = smiapp_start_streaming(sensor);
                if (rval < 0)
                        sensor->streaming = false;
        } else {
                rval = smiapp_stop_streaming(sensor);
                sensor->streaming = false;
+               pm_runtime_mark_last_busy(&client->dev);
+               pm_runtime_put_autosuspend(&client->dev);
        }
 
        return rval;
@@ -2654,7 +2649,6 @@ static int smiapp_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh)
        struct smiapp_subdev *ssd = to_smiapp_subdev(sd);
        struct smiapp_sensor *sensor = ssd->sensor;
        unsigned int i;
-       int rval;
 
        mutex_lock(&sensor->mutex);
 
@@ -2681,22 +2675,6 @@ static int smiapp_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh)
 
        mutex_unlock(&sensor->mutex);
 
-       rval = pm_runtime_get_sync(sd->dev);
-       if (rval >= 0)
-               return 0;
-
-       if (rval != -EBUSY && rval != -EAGAIN)
-               pm_runtime_set_active(sd->dev);
-       pm_runtime_put(sd->dev);
-
-       return rval;
-}
-
-static int smiapp_close(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh)
-{
-       pm_runtime_mark_last_busy(sd->dev);
-       pm_runtime_put_autosuspend(sd->dev);
-
        return 0;
 }
 
@@ -2704,10 +2682,6 @@ static const struct v4l2_subdev_video_ops smiapp_video_ops = {
        .s_stream = smiapp_set_stream,
 };
 
-static const struct v4l2_subdev_core_ops smiapp_core_ops = {
-       .s_power = smiapp_set_power,
-};
-
 static const struct v4l2_subdev_pad_ops smiapp_pad_ops = {
        .enum_mbus_code = smiapp_enum_mbus_code,
        .get_fmt = smiapp_get_format,
@@ -2722,7 +2696,6 @@ static const struct v4l2_subdev_sensor_ops smiapp_sensor_ops = {
 };
 
 static const struct v4l2_subdev_ops smiapp_ops = {
-       .core = &smiapp_core_ops,
        .video = &smiapp_video_ops,
        .pad = &smiapp_pad_ops,
        .sensor = &smiapp_sensor_ops,
@@ -2736,12 +2709,10 @@ static const struct v4l2_subdev_internal_ops smiapp_internal_src_ops = {
        .registered = smiapp_registered,
        .unregistered = smiapp_unregistered,
        .open = smiapp_open,
-       .close = smiapp_close,
 };
 
 static const struct v4l2_subdev_internal_ops smiapp_internal_ops = {
        .open = smiapp_open,
-       .close = smiapp_close,
 };
 
 /* -----------------------------------------------------------------------------

diff --git a/drivers/media/i2c/smiapp/smiapp-regs.c b/drivers/media/i2c/smiapp/smiapp-regs.c
index d6779e35d36f2d4e7560f37cc674b19c449a2359..145653dc81dae76175dba0daf74282de1cf19108 100644 (file)
--- a/drivers/media/i2c/smiapp/smiapp-regs.c
+++ b/drivers/media/i2c/smiapp/smiapp-regs.c
@@ -231,6 +231,9 @@ int smiapp_write_no_quirk(struct smiapp_sensor *sensor, u32 reg, u32 val)
             len != SMIAPP_REG_32BIT) || flags)
                return -EINVAL;
 
+       if (!sensor->active)
+               return 0;
+
        msg.addr = client->addr;
        msg.flags = 0; /* Write */
        msg.len = 2 + len;

diff --git a/drivers/media/i2c/smiapp/smiapp.h b/drivers/media/i2c/smiapp/smiapp.h
index f74d695018b91b8ed79d79204ce06e75b21e93d3..e6a5ab402d7f8f115fd73a25bf2383d1534e09fe 100644 (file)
--- a/drivers/media/i2c/smiapp/smiapp.h
+++ b/drivers/media/i2c/smiapp/smiapp.h
@@ -206,6 +206,7 @@ struct smiapp_sensor {
 
        u8 hvflip_inv_mask; /* H/VFLIP inversion due to sensor orientation */
        u8 frame_skip;
+       bool active; /* is the sensor powered on? */
        u16 embedded_start; /* embedded data start line */
        u16 embedded_end;
        u16 image_start; /* image data start line */