Merge "drivers: thermal: Avoid multiple TSENS controller re-init simultaneously" (1eccf98e) · Commits · e / devices / android_kernel_xiaomi_sm6125

drivers/thermal/tsens.h

+1 −0

Original line number	Diff line number	Diff line
		@@ -231,6 +231,7 @@ struct tsens_device {
		struct workqueue_struct *tsens_reinit_work;
		struct work_struct therm_fwk_notify;
		bool tsens_reinit_wa;
		int tsens_reinit_cnt;
		struct tsens_sensor sensor[0];
		};

drivers/thermal/tsens2xxx.c

+30 −1

Original line number	Diff line number	Diff line
		@@ -69,6 +69,7 @@
		#define TSENS_TM_TRDY_FIRST_ROUND_COMPLETE_SHIFT 3
		#define TSENS_INIT_ID 0x5
		#define TSENS_RECOVERY_LOOP_COUNT 5
		#define TSENS_RE_INIT_MAX_COUNT 5

		static void msm_tsens_convert_temp(int last_temp, int *temp)
		{
		@@ -88,6 +89,7 @@ static int tsens2xxx_get_temp(struct tsens_sensor sensor, int temp)
		unsigned int code, ret, tsens_ret;
		void __iomem sensor_addr, trdy;
		int last_temp = 0, last_temp2 = 0, last_temp3 = 0, count = 0;
		static atomic_t in_tsens_reinit;

		if (!sensor)
		return -EINVAL;
		@@ -100,8 +102,14 @@ static int tsens2xxx_get_temp(struct tsens_sensor sensor, int temp)

		if (!((code & TSENS_TM_TRDY_FIRST_ROUND_COMPLETE) >>
		TSENS_TM_TRDY_FIRST_ROUND_COMPLETE_SHIFT)) {
		if (atomic_read(&in_tsens_reinit)) {
		pr_err("%s: tsens re-init is in progress\n", __func__);
		return -EAGAIN;
		}

		pr_err("%s: tsens device first round not complete0x%x\n",
		__func__, code);

		/* Wait for 2.5 ms for tsens controller to recover */
		do {
		udelay(500);
		@@ -121,9 +129,26 @@ static int tsens2xxx_get_temp(struct tsens_sensor sensor, int temp)
		if (tmdev->tsens_reinit_wa) {
		struct scm_desc desc = { 0 };

		if (atomic_read(&in_tsens_reinit)) {
		pr_err("%s: tsens re-init is in progress\n",
		__func__);
		return -EAGAIN;
		}

		atomic_set(&in_tsens_reinit, 1);

		if (tmdev->ops->dbg)
		tmdev->ops->dbg(tmdev, 0,
		TSENS_DBG_LOG_BUS_ID_DATA, NULL);

		if (tmdev->tsens_reinit_cnt >=
		TSENS_RE_INIT_MAX_COUNT) {
		pr_err(
		"%s: TSENS not recovered after %d re-init\n",
		__func__, tmdev->tsens_reinit_cnt);
		BUG();
		}

		/* Make an scm call to re-init TSENS */
		TSENS_DBG(tmdev, "%s",
		"Calling TZ to re-init TSENS\n");
		@@ -142,6 +167,9 @@ static int tsens2xxx_get_temp(struct tsens_sensor sensor, int temp)
		__func__, tsens_ret);
		BUG();
		}
		tmdev->tsens_reinit_cnt++;
		atomic_set(&in_tsens_reinit, 0);

		/* Notify thermal fwk */
		list_for_each_entry(tmdev_itr,
		&tsens_device_list, list) {
		@@ -159,6 +187,7 @@ static int tsens2xxx_get_temp(struct tsens_sensor sensor, int temp)
		sensor_read:

		tmdev->trdy_fail_ctr = 0;
		tmdev->tsens_reinit_cnt = 0;

		code = readl_relaxed_no_log(sensor_addr +
		(sensor->hw_id << TSENS_STATUS_ADDR_OFFSET));