diff mbox series

[2/6] media: camss: ispif: Correctly reset based on the VFE ID

Message ID 20201018125237.16717-3-kholk11@gmail.com
State Accepted
Commit 864ed874d74a36e9b708e41c98cf791bb7786507
Headers show
Series None | expand

Commit Message

AngeloGioacchino Del Regno Oct. 18, 2020, 12:52 p.m. UTC
From: AngeloGioacchino Del Regno <kholk11@gmail.com>

Resetting the ISPIF VFE0 context is wrong if we are using the VFE1
for dual-camera or simply because a secondary camera is connected
to it: in this case the reset will always happen on the VFE0 ctx
of the ISPIF, which is .. useless.

Fix this usecase by adding the ISPIF_RST_CMD_1 address and choose
where to do the (or what to) reset based on the VFE line id.

Signed-off-by: AngeloGioacchino Del Regno <kholk11@gmail.com>
---
 .../media/platform/qcom/camss/camss-ispif.c   | 87 ++++++++++++-------
 .../media/platform/qcom/camss/camss-ispif.h   |  2 +-
 2 files changed, 57 insertions(+), 32 deletions(-)

Comments

Robert Foss Oct. 20, 2020, 9:02 a.m. UTC | #1
I found a build issue in this commit.


On Tue, 20 Oct 2020 at 10:59, Robert Foss <robert.foss@linaro.org> wrote:
>
> Nice catch! This patch looks good to me.
>
> Signed-off-by: Robert Foss <robert.foss@linaro.org>
>
> On Sun, 18 Oct 2020 at 14:54, <kholk11@gmail.com> wrote:
> >
> > From: AngeloGioacchino Del Regno <kholk11@gmail.com>
> >
> > Resetting the ISPIF VFE0 context is wrong if we are using the VFE1
> > for dual-camera or simply because a secondary camera is connected
> > to it: in this case the reset will always happen on the VFE0 ctx
> > of the ISPIF, which is .. useless.
> >
> > Fix this usecase by adding the ISPIF_RST_CMD_1 address and choose
> > where to do the (or what to) reset based on the VFE line id.
> >
> > Signed-off-by: AngeloGioacchino Del Regno <kholk11@gmail.com>
> > ---
> >  .../media/platform/qcom/camss/camss-ispif.c   | 87 ++++++++++++-------
> >  .../media/platform/qcom/camss/camss-ispif.h   |  2 +-
> >  2 files changed, 57 insertions(+), 32 deletions(-)
> >
> > diff --git a/drivers/media/platform/qcom/camss/camss-ispif.c b/drivers/media/platform/qcom/camss/camss-ispif.c
> > index db94cfd6c508..252db6b33dab 100644
> > --- a/drivers/media/platform/qcom/camss/camss-ispif.c
> > +++ b/drivers/media/platform/qcom/camss/camss-ispif.c
> > @@ -26,6 +26,7 @@
> >  #define MSM_ISPIF_NAME "msm_ispif"
> >
> >  #define ISPIF_RST_CMD_0                        0x008
> > +#define ISPIF_RST_CMD_1                        0x00c
> >  #define ISPIF_RST_CMD_0_STROBED_RST_EN         (1 << 0)
> >  #define ISPIF_RST_CMD_0_MISC_LOGIC_RST         (1 << 1)
> >  #define ISPIF_RST_CMD_0_SW_REG_RST             (1 << 2)
> > @@ -179,7 +180,10 @@ static irqreturn_t ispif_isr_8x96(int irq, void *dev)
> >         writel(0x1, ispif->base + ISPIF_IRQ_GLOBAL_CLEAR_CMD);
> >
> >         if ((value0 >> 27) & 0x1)
> > -               complete(&ispif->reset_complete);
> > +               complete(&ispif->reset_complete[0]);
> > +
> > +       if ((value3 >> 27) & 0x1)
> > +               complete(&ispif->reset_complete[1]);
> >
> >         if (unlikely(value0 & ISPIF_VFE_m_IRQ_STATUS_0_PIX0_OVERFLOW))
> >                 dev_err_ratelimited(to_device(ispif), "VFE0 pix0 overflow\n");
> > @@ -237,7 +241,7 @@ static irqreturn_t ispif_isr_8x16(int irq, void *dev)
> >         writel(0x1, ispif->base + ISPIF_IRQ_GLOBAL_CLEAR_CMD);
> >
> >         if ((value0 >> 27) & 0x1)
> > -               complete(&ispif->reset_complete);
> > +               complete(&ispif->reset_complete[0]);
> >
> >         if (unlikely(value0 & ISPIF_VFE_m_IRQ_STATUS_0_PIX0_OVERFLOW))
> >                 dev_err_ratelimited(to_device(ispif), "VFE0 pix0 overflow\n");
> > @@ -257,33 +261,17 @@ static irqreturn_t ispif_isr_8x16(int irq, void *dev)
> >         return IRQ_HANDLED;
> >  }
> >
> > -/*
> > - * ispif_reset - Trigger reset on ISPIF module and wait to complete
> > - * @ispif: ISPIF device
> > - *
> > - * Return 0 on success or a negative error code otherwise
> > - */
> > -static int ispif_reset(struct ispif_device *ispif)
> > +static int ispif_vfe_reset(struct ispif_device *ispif, u8 vfe_id)
> >  {
> > -       unsigned long time;
> >         u32 val;
> > -       int ret;
> > -
> > -       ret = camss_pm_domain_on(to_camss(ispif), PM_DOMAIN_VFE0);
> > -       if (ret < 0)
> > -               return ret;
> >
> > -       ret = camss_pm_domain_on(to_camss(ispif), PM_DOMAIN_VFE1);
> > -       if (ret < 0)
> > -               return ret;
> > -
> > -       ret = camss_enable_clocks(ispif->nclocks_for_reset,
> > -                                 ispif->clock_for_reset,
> > -                                 to_device(ispif));
> > -       if (ret < 0)
> > -               return ret;
> > +       if (vfe_id > (to_camss(ispif)->vfe_num - 1)) {
> > +               dev_err(to_device(ispif),
> > +                       "Error: asked reset for invalid VFE%d\n", vfe_id);
> > +               return -ENOENT;
> > +       }
> >
> > -       reinit_completion(&ispif->reset_complete);
> > +       reinit_completion(&ispif->reset_complete[vfe_id]);
> >
> >         val = ISPIF_RST_CMD_0_STROBED_RST_EN |
> >                 ISPIF_RST_CMD_0_MISC_LOGIC_RST |
> > @@ -303,15 +291,51 @@ static int ispif_reset(struct ispif_device *ispif)
> >                 ISPIF_RST_CMD_0_RDI_OUTPUT_1_MISR_RST |
> >                 ISPIF_RST_CMD_0_RDI_OUTPUT_2_MISR_RST;
> >
> > -       writel_relaxed(val, ispif->base + ISPIF_RST_CMD_0);
> > +       if (vfe_id == 1)
> > +               writel_relaxed(val, ispif->base + ISPIF_RST_CMD_1);
> > +       else
> > +               writel_relaxed(val, ispif->base + ISPIF_RST_CMD_0);
> >
> > -       time = wait_for_completion_timeout(&ispif->reset_complete,
> > +       time = wait_for_completion_timeout(&ispif->reset_complete[vfe_id],

'time' is not a variable that exists in this scope, so the build fails.

> >                 msecs_to_jiffies(ISPIF_RESET_TIMEOUT_MS));
> >         if (!time) {
> > -               dev_err(to_device(ispif), "ISPIF reset timeout\n");
> > -               ret = -EIO;
> > +               dev_err(to_device(ispif),
> > +                       "ISPIF for VFE%d reset timeout\n", vfe_id);
> > +               return -EIO;
> >         }
> >
> > +       return 0;
> > +}
> > +
> > +/*
> > + * ispif_reset - Trigger reset on ISPIF module and wait to complete
> > + * @ispif: ISPIF device
> > + *
> > + * Return 0 on success or a negative error code otherwise
> > + */
> > +static int ispif_reset(struct ispif_device *ispif, u8 vfe_id)
> > +{
> > +       unsigned long time;
> > +       int ret;
> > +
> > +       ret = camss_pm_domain_on(to_camss(ispif), PM_DOMAIN_VFE0);
> > +       if (ret < 0)
> > +               return ret;
> > +
> > +       ret = camss_pm_domain_on(to_camss(ispif), PM_DOMAIN_VFE1);
> > +       if (ret < 0)
> > +               return ret;
> > +
> > +       ret = camss_enable_clocks(ispif->nclocks_for_reset,
> > +                                 ispif->clock_for_reset,
> > +                                 to_device(ispif));
> > +       if (ret < 0)
> > +               return ret;
> > +
> > +       ret = ispif_vfe_reset(ispif, vfe_id);
> > +       if (ret)
> > +               dev_dbg(to_device(ispif), "ISPIF Reset failed\n");
> > +
> >         camss_disable_clocks(ispif->nclocks_for_reset, ispif->clock_for_reset);
> >
> >         camss_pm_domain_off(to_camss(ispif), PM_DOMAIN_VFE0);
> > @@ -355,7 +379,7 @@ static int ispif_set_power(struct v4l2_subdev *sd, int on)
> >                         goto exit;
> >                 }
> >
> > -               ret = ispif_reset(ispif);
> > +               ret = ispif_reset(ispif, line->vfe_id);
> >                 if (ret < 0) {
> >                         pm_runtime_put_sync(dev);
> >                         camss_disable_clocks(ispif->nclocks, ispif->clock);
> > @@ -1192,7 +1216,8 @@ int msm_ispif_subdev_init(struct ispif_device *ispif,
> >
> >         mutex_init(&ispif->config_lock);
> >
> > -       init_completion(&ispif->reset_complete);
> > +       for (i = 0; i < MSM_ISPIF_VFE_NUM; i++)
> > +               init_completion(&ispif->reset_complete[i]);
> >
> >         return 0;
> >  }
> > diff --git a/drivers/media/platform/qcom/camss/camss-ispif.h b/drivers/media/platform/qcom/camss/camss-ispif.h
> > index 1a5ba2425a42..4132174f7ea1 100644
> > --- a/drivers/media/platform/qcom/camss/camss-ispif.h
> > +++ b/drivers/media/platform/qcom/camss/camss-ispif.h
> > @@ -56,7 +56,7 @@ struct ispif_device {
> >         int nclocks;
> >         struct camss_clock  *clock_for_reset;
> >         int nclocks_for_reset;
> > -       struct completion reset_complete;
> > +       struct completion reset_complete[MSM_ISPIF_VFE_NUM];
> >         int power_count;
> >         struct mutex power_lock;
> >         struct ispif_intf_cmd_reg intf_cmd[MSM_ISPIF_VFE_NUM];
> > --
> > 2.28.0
> >
diff mbox series

Patch

diff --git a/drivers/media/platform/qcom/camss/camss-ispif.c b/drivers/media/platform/qcom/camss/camss-ispif.c
index db94cfd6c508..252db6b33dab 100644
--- a/drivers/media/platform/qcom/camss/camss-ispif.c
+++ b/drivers/media/platform/qcom/camss/camss-ispif.c
@@ -26,6 +26,7 @@ 
 #define MSM_ISPIF_NAME "msm_ispif"
 
 #define ISPIF_RST_CMD_0			0x008
+#define ISPIF_RST_CMD_1			0x00c
 #define ISPIF_RST_CMD_0_STROBED_RST_EN		(1 << 0)
 #define ISPIF_RST_CMD_0_MISC_LOGIC_RST		(1 << 1)
 #define ISPIF_RST_CMD_0_SW_REG_RST		(1 << 2)
@@ -179,7 +180,10 @@  static irqreturn_t ispif_isr_8x96(int irq, void *dev)
 	writel(0x1, ispif->base + ISPIF_IRQ_GLOBAL_CLEAR_CMD);
 
 	if ((value0 >> 27) & 0x1)
-		complete(&ispif->reset_complete);
+		complete(&ispif->reset_complete[0]);
+
+	if ((value3 >> 27) & 0x1)
+		complete(&ispif->reset_complete[1]);
 
 	if (unlikely(value0 & ISPIF_VFE_m_IRQ_STATUS_0_PIX0_OVERFLOW))
 		dev_err_ratelimited(to_device(ispif), "VFE0 pix0 overflow\n");
@@ -237,7 +241,7 @@  static irqreturn_t ispif_isr_8x16(int irq, void *dev)
 	writel(0x1, ispif->base + ISPIF_IRQ_GLOBAL_CLEAR_CMD);
 
 	if ((value0 >> 27) & 0x1)
-		complete(&ispif->reset_complete);
+		complete(&ispif->reset_complete[0]);
 
 	if (unlikely(value0 & ISPIF_VFE_m_IRQ_STATUS_0_PIX0_OVERFLOW))
 		dev_err_ratelimited(to_device(ispif), "VFE0 pix0 overflow\n");
@@ -257,33 +261,17 @@  static irqreturn_t ispif_isr_8x16(int irq, void *dev)
 	return IRQ_HANDLED;
 }
 
-/*
- * ispif_reset - Trigger reset on ISPIF module and wait to complete
- * @ispif: ISPIF device
- *
- * Return 0 on success or a negative error code otherwise
- */
-static int ispif_reset(struct ispif_device *ispif)
+static int ispif_vfe_reset(struct ispif_device *ispif, u8 vfe_id)
 {
-	unsigned long time;
 	u32 val;
-	int ret;
-
-	ret = camss_pm_domain_on(to_camss(ispif), PM_DOMAIN_VFE0);
-	if (ret < 0)
-		return ret;
 
-	ret = camss_pm_domain_on(to_camss(ispif), PM_DOMAIN_VFE1);
-	if (ret < 0)
-		return ret;
-
-	ret = camss_enable_clocks(ispif->nclocks_for_reset,
-				  ispif->clock_for_reset,
-				  to_device(ispif));
-	if (ret < 0)
-		return ret;
+	if (vfe_id > (to_camss(ispif)->vfe_num - 1)) {
+		dev_err(to_device(ispif),
+			"Error: asked reset for invalid VFE%d\n", vfe_id);
+		return -ENOENT;
+	}
 
-	reinit_completion(&ispif->reset_complete);
+	reinit_completion(&ispif->reset_complete[vfe_id]);
 
 	val = ISPIF_RST_CMD_0_STROBED_RST_EN |
 		ISPIF_RST_CMD_0_MISC_LOGIC_RST |
@@ -303,15 +291,51 @@  static int ispif_reset(struct ispif_device *ispif)
 		ISPIF_RST_CMD_0_RDI_OUTPUT_1_MISR_RST |
 		ISPIF_RST_CMD_0_RDI_OUTPUT_2_MISR_RST;
 
-	writel_relaxed(val, ispif->base + ISPIF_RST_CMD_0);
+	if (vfe_id == 1)
+		writel_relaxed(val, ispif->base + ISPIF_RST_CMD_1);
+	else
+		writel_relaxed(val, ispif->base + ISPIF_RST_CMD_0);
 
-	time = wait_for_completion_timeout(&ispif->reset_complete,
+	time = wait_for_completion_timeout(&ispif->reset_complete[vfe_id],
 		msecs_to_jiffies(ISPIF_RESET_TIMEOUT_MS));
 	if (!time) {
-		dev_err(to_device(ispif), "ISPIF reset timeout\n");
-		ret = -EIO;
+		dev_err(to_device(ispif),
+			"ISPIF for VFE%d reset timeout\n", vfe_id);
+		return -EIO;
 	}
 
+	return 0;
+}
+
+/*
+ * ispif_reset - Trigger reset on ISPIF module and wait to complete
+ * @ispif: ISPIF device
+ *
+ * Return 0 on success or a negative error code otherwise
+ */
+static int ispif_reset(struct ispif_device *ispif, u8 vfe_id)
+{
+	unsigned long time;
+	int ret;
+
+	ret = camss_pm_domain_on(to_camss(ispif), PM_DOMAIN_VFE0);
+	if (ret < 0)
+		return ret;
+
+	ret = camss_pm_domain_on(to_camss(ispif), PM_DOMAIN_VFE1);
+	if (ret < 0)
+		return ret;
+
+	ret = camss_enable_clocks(ispif->nclocks_for_reset,
+				  ispif->clock_for_reset,
+				  to_device(ispif));
+	if (ret < 0)
+		return ret;
+
+	ret = ispif_vfe_reset(ispif, vfe_id);
+	if (ret)
+		dev_dbg(to_device(ispif), "ISPIF Reset failed\n");
+
 	camss_disable_clocks(ispif->nclocks_for_reset, ispif->clock_for_reset);
 
 	camss_pm_domain_off(to_camss(ispif), PM_DOMAIN_VFE0);
@@ -355,7 +379,7 @@  static int ispif_set_power(struct v4l2_subdev *sd, int on)
 			goto exit;
 		}
 
-		ret = ispif_reset(ispif);
+		ret = ispif_reset(ispif, line->vfe_id);
 		if (ret < 0) {
 			pm_runtime_put_sync(dev);
 			camss_disable_clocks(ispif->nclocks, ispif->clock);
@@ -1192,7 +1216,8 @@  int msm_ispif_subdev_init(struct ispif_device *ispif,
 
 	mutex_init(&ispif->config_lock);
 
-	init_completion(&ispif->reset_complete);
+	for (i = 0; i < MSM_ISPIF_VFE_NUM; i++)
+		init_completion(&ispif->reset_complete[i]);
 
 	return 0;
 }
diff --git a/drivers/media/platform/qcom/camss/camss-ispif.h b/drivers/media/platform/qcom/camss/camss-ispif.h
index 1a5ba2425a42..4132174f7ea1 100644
--- a/drivers/media/platform/qcom/camss/camss-ispif.h
+++ b/drivers/media/platform/qcom/camss/camss-ispif.h
@@ -56,7 +56,7 @@  struct ispif_device {
 	int nclocks;
 	struct camss_clock  *clock_for_reset;
 	int nclocks_for_reset;
-	struct completion reset_complete;
+	struct completion reset_complete[MSM_ISPIF_VFE_NUM];
 	int power_count;
 	struct mutex power_lock;
 	struct ispif_intf_cmd_reg intf_cmd[MSM_ISPIF_VFE_NUM];