Merge "power: qpnp-fg: add support to sanity check FG state" (d3d6248c) · Commits · e / devices / android_kernel_xiaomi_markw

drivers/power/qpnp-fg.c

+69 −0

Original line number	Diff line number	Diff line
		@@ -602,6 +602,10 @@ struct fg_chip {
		int cc_soc_limit_pct;
		bool use_last_cc_soc;
		int64_t last_cc_soc;
		/* Sanity check */
		struct delayed_work check_sanity_work;
		struct fg_wakeup_source sanity_wakeup_source;
		u8 last_beat_count;
		};

		/* FG_MEMIF DEBUGFS structures */
		@@ -2537,6 +2541,52 @@ out:
		return rc;
		}

		#define SANITY_CHECK_PERIOD_MS 5000
		static void check_sanity_work(struct work_struct *work)
		{
		struct fg_chip *chip = container_of(work,
		struct fg_chip,
		check_sanity_work.work);
		int rc = 0;
		u8 beat_count;
		bool tried_once = false;

		fg_stay_awake(&chip->sanity_wakeup_source);

		try_again:
		rc = fg_read(chip, &beat_count,
		chip->mem_base + MEM_INTF_FG_BEAT_COUNT, 1);
		if (rc) {
		pr_err("failed to read beat count rc=%d\n", rc);
		goto resched;
		}

		if (fg_debug_mask & FG_STATUS)
		pr_info("current: %d, prev: %d\n", beat_count,
		chip->last_beat_count);

		if (chip->last_beat_count == beat_count) {
		if (!tried_once) {
		/* Wait for 1 FG cycle and read it once again */
		msleep(1500);
		tried_once = true;
		goto try_again;
		} else {
		pr_err("Beat count not updating\n");
		fg_check_ima_error_handling(chip);
		goto out;
		}
		} else {
		chip->last_beat_count = beat_count;
		}
		resched:
		schedule_delayed_work(
		&chip->check_sanity_work,
		msecs_to_jiffies(SANITY_CHECK_PERIOD_MS));
		out:
		fg_relax(&chip->sanity_wakeup_source);
		}

		#define SRAM_TIMEOUT_MS 3000
		static void update_sram_data_work(struct work_struct *work)
		{
		@@ -6693,6 +6743,7 @@ static int fg_init_irqs(struct fg_chip *chip)

		static void fg_cancel_all_works(struct fg_chip *chip)
		{
		cancel_delayed_work_sync(&chip->check_sanity_work);
		cancel_delayed_work_sync(&chip->update_sram_data);
		cancel_delayed_work_sync(&chip->update_temp_work);
		cancel_delayed_work_sync(&chip->update_jeita_setting);
		@@ -6742,6 +6793,7 @@ static void fg_cleanup(struct fg_chip *chip)
		wakeup_source_trash(&chip->dischg_gain_wakeup_source.source);
		wakeup_source_trash(&chip->fg_reset_wakeup_source.source);
		wakeup_source_trash(&chip->cc_soc_wakeup_source.source);
		wakeup_source_trash(&chip->sanity_wakeup_source.source);
		}

		static int fg_remove(struct spmi_device *spmi)
		@@ -7727,6 +7779,8 @@ out:
		fg_enable_irqs(chip, true);
		update_sram_data_work(&chip->update_sram_data.work);
		update_temp_data(&chip->update_temp_work.work);
		schedule_delayed_work(&chip->check_sanity_work,
		msecs_to_jiffies(1000));
		chip->ima_error_handling = false;
		mutex_unlock(&chip->ima_recovery_lock);
		fg_relax(&chip->fg_reset_wakeup_source);
		@@ -7866,6 +7920,10 @@ static void delayed_init_work(struct work_struct *work)
		if (!chip->use_otp_profile)
		schedule_delayed_work(&chip->batt_profile_init, 0);

		if (chip->ima_supported && fg_reset_on_lockup)
		schedule_delayed_work(&chip->check_sanity_work,
		msecs_to_jiffies(1000));

		if (chip->wa_flag & IADC_GAIN_COMP_WA) {
		rc = fg_init_iadc_config(chip);
		if (rc)
		@@ -7935,6 +7993,8 @@ static int fg_probe(struct spmi_device *spmi)
		"qpnp_fg_reset");
		wakeup_source_init(&chip->cc_soc_wakeup_source.source,
		"qpnp_fg_cc_soc");
		wakeup_source_init(&chip->sanity_wakeup_source.source,
		"qpnp_fg_sanity_check");
		spin_lock_init(&chip->sec_access_lock);
		mutex_init(&chip->rw_lock);
		mutex_init(&chip->cyc_ctr.lock);
		@@ -7947,6 +8007,7 @@ static int fg_probe(struct spmi_device *spmi)
		INIT_DELAYED_WORK(&chip->update_temp_work, update_temp_data);
		INIT_DELAYED_WORK(&chip->check_empty_work, check_empty_work);
		INIT_DELAYED_WORK(&chip->batt_profile_init, batt_profile_init);
		INIT_DELAYED_WORK(&chip->check_sanity_work, check_sanity_work);
		INIT_WORK(&chip->ima_error_recovery_work, ima_error_recovery_work);
		INIT_WORK(&chip->rslow_comp_work, rslow_comp_work);
		INIT_WORK(&chip->fg_cap_learning_work, fg_cap_learning_work);
		@@ -8139,6 +8200,7 @@ of_init_fail:
		wakeup_source_trash(&chip->dischg_gain_wakeup_source.source);
		wakeup_source_trash(&chip->fg_reset_wakeup_source.source);
		wakeup_source_trash(&chip->cc_soc_wakeup_source.source);
		wakeup_source_trash(&chip->sanity_wakeup_source.source);
		return rc;
		}

		@@ -8275,6 +8337,13 @@ static int fg_reset_lockup_set(const char val, const struct kernel_param kp)

		if (fg_debug_mask & FG_STATUS)
		pr_info("fg_reset_on_lockup set to %d\n", fg_reset_on_lockup);

		if (fg_reset_on_lockup)
		schedule_delayed_work(&chip->check_sanity_work,
		msecs_to_jiffies(1000));
		else
		cancel_delayed_work_sync(&chip->check_sanity_work);

		return rc;
		}