msm-camera: add support for cx_ipeak

camera drivers need to vote when moving to turbo clock
and unvote when moving out of turbo. cx_ipeak driver
then makes sure to limit the current drawn from cx
based on this vote. This dirver provides common utility
functions to track vote and unvote.

Change-Id: I34d860003518924ab3233d8de24ccdb11f513f7e
Signed-off-by: Srikanth Uyyala <suyyala@codeaurora.org>

3 files changed, 114 insertions, 1 deletions

diff --git a/drivers/media/platform/msm/camera_v2/common/Makefile b/drivers/media/platform/msm/camera_v2/common/Makefile
index 74fe58f430e0..e3765fc4c524 100644
--- a/drivers/media/platform/msm/camera_v2/common/Makefile
+++ b/drivers/media/platform/msm/camera_v2/common/Makefile
@@ -1,3 +1,3 @@
 ccflags-y += -Idrivers/media/platform/msm/camera_v2/
 ccflags-y += -Idrivers/misc/
-obj-$(CONFIG_MSMB_CAMERA) += msm_camera_io_util.o cam_smmu_api.o cam_hw_ops.o cam_soc_api.o msm_camera_tz_util.o
+obj-$(CONFIG_MSMB_CAMERA) += msm_camera_io_util.o cam_smmu_api.o cam_hw_ops.o cam_soc_api.o msm_camera_tz_util.o msm_cam_cx_ipeak.o
diff --git a/drivers/media/platform/msm/camera_v2/common/msm_cam_cx_ipeak.c b/drivers/media/platform/msm/camera_v2/common/msm_cam_cx_ipeak.c
new file mode 100644
index 000000000000..d9cea15eb666
--- /dev/null
+++ b/drivers/media/platform/msm/camera_v2/common/msm_cam_cx_ipeak.c
@@ -0,0 +1,89 @@
+/* Copyright (c) 2019, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#include <linux/of.h>
+#include <linux/clk.h>
+#include <linux/slab.h>
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+#include <soc/qcom/cx_ipeak.h>
+#include "msm_cam_cx_ipeak.h"
+
+static struct cx_ipeak_client *cam_cx_ipeak;
+static int cx_default_ipeak_mask;
+static int cx_current_ipeak_mask;
+static int cam_cx_client_cnt;
+
+int cam_cx_ipeak_register_cx_ipeak(struct cx_ipeak_client *p_cam_cx_ipeak,
+	int *cam_cx_ipeak_bit)
+{
+	int rc = 0;
+
+	*cam_cx_ipeak_bit = 1 << cam_cx_client_cnt++;
+	cx_default_ipeak_mask |= *cam_cx_ipeak_bit;
+
+	if (cam_cx_ipeak)
+		goto exit;
+
+	cam_cx_ipeak = p_cam_cx_ipeak;
+
+	if (!cam_cx_ipeak)
+		rc = -EINVAL;
+
+exit:
+	pr_debug("%s: client_cnt %d client mask = %x default_mask = %x\n",
+		__func__, cam_cx_client_cnt, *cam_cx_ipeak_bit,
+		cx_default_ipeak_mask);
+	return rc;
+}
+
+int cam_cx_ipeak_update_vote_cx_ipeak(int cam_cx_ipeak_bit)
+{
+	int32_t soc_cx_ipeak_bit = cam_cx_ipeak_bit;
+	int ret = 0;
+
+	pr_debug("%s: E: current_mask = %x default_mask = %x new bit = %x\n",
+		__func__, cx_current_ipeak_mask,
+		cx_default_ipeak_mask, soc_cx_ipeak_bit);
+
+	cx_current_ipeak_mask |= soc_cx_ipeak_bit;
+	pr_debug("%s: current_mask = %x\n", __func__, cx_current_ipeak_mask);
+
+	if (cx_current_ipeak_mask == cx_default_ipeak_mask) {
+		if (cam_cx_ipeak) {
+			ret = cx_ipeak_update(cam_cx_ipeak, true);
+			if (ret)
+				goto exit;
+			pr_debug("%s: X: All client VOTE\n", __func__);
+		}
+	}
+exit:
+	return ret;
+}
+
+int cam_cx_ipeak_unvote_cx_ipeak(int cam_cx_ipeak_bit)
+{
+	int32_t soc_cx_ipeak_bit = cam_cx_ipeak_bit;
+
+	pr_debug("%s: current_mask = %x soc_cx_ipeak_bit = %x\n", __func__,
+		cx_current_ipeak_mask, soc_cx_ipeak_bit);
+	if (cx_current_ipeak_mask == cx_default_ipeak_mask) {
+		if (cam_cx_ipeak)
+			cx_ipeak_update(cam_cx_ipeak, false);
+		pr_debug("%s: One client requested UNVOTE\n", __func__);
+	}
+	cx_current_ipeak_mask &= (~soc_cx_ipeak_bit);
+	pr_debug("%s:X:updated cx_current_ipeak_mask = %x\n", __func__,
+		cx_current_ipeak_mask);
+
+	return 0;
+}
diff --git a/drivers/media/platform/msm/camera_v2/common/msm_cam_cx_ipeak.h b/drivers/media/platform/msm/camera_v2/common/msm_cam_cx_ipeak.h
new file mode 100644
index 000000000000..b60b896eb060
--- /dev/null
+++ b/drivers/media/platform/msm/camera_v2/common/msm_cam_cx_ipeak.h
@@ -0,0 +1,24 @@
+/* Copyright (c) 2019, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#ifndef _MSM_CAM_CX_IPEAK_H_
+#define _MSM_CAM_CX_IPEAK_H_
+
+#include <soc/qcom/cx_ipeak.h>
+
+int cam_cx_ipeak_register_cx_ipeak(struct cx_ipeak_client *p_cam_cx_ipeak,
+	int *cam_cx_ipeak_bit);
+
+int cam_cx_ipeak_update_vote_cx_ipeak(int cam_cx_ipeak_bit);
+int cam_cx_ipeak_unvote_cx_ipeak(int cam_cx_ipeak_bit);
+
+#endif /* _CAM_CX_IPEAK_H_ */