qcacld-3.0: Restart TSF sync timer post wlan resume

TSF sync routine stopped due to host suspend and post wlan resume the TSF
sync peridic timer resumes. Old host to TSF mapping data being used for
use cases which may be invalid as it was captured long back. Hence Restart
the TSF sync soon afer wlan resume to synchronize at the earliest.

Change-Id: I141755e23fe288fb31925c8d87f37cfccced0203
CRs-Fixed: 3303130

core/hdd/inc/wlan_hdd_main.h

@@ -998,6 +998,7 @@ struct wlm_multi_client_info_table {
  * @vdev_id: Unique identifier assigned to the vdev
  * @event_flags: a bitmap of hdd_adapter_flags
  * @enable_dynamic_tsf_sync: Enable/Disable TSF sync through NL interface
+ * @host_target_sync_force: Force update host to TSF mapping
  * @dynamic_tsf_sync_interval: TSF sync interval configure through NL interface
  * @gpio_tsf_sync_work: work to sync send TSF CAP WMI command
  * @cache_sta_count: number of currently cached stations
@@ -1170,6 +1171,7 @@ struct hdd_adapter {
 	qdf_spinlock_t host_target_sync_lock;
 	qdf_mc_timer_t host_target_sync_timer;
 	bool enable_dynamic_tsf_sync;
+	bool host_target_sync_force;
 	uint32_t dynamic_tsf_sync_interval;
 	uint64_t cur_host_time;
 	uint64_t last_host_time;

core/hdd/inc/wlan_hdd_tsf.h

@@ -235,6 +235,16 @@ bool hdd_tsf_is_dbg_fs_set(struct hdd_context *hdd);
  */
 int hdd_start_tsf_sync(struct hdd_adapter *adapter);
 
+/**
+ * hdd_restart_tsf_sync_post_wlan_resume() - restart host TSF sync
+ * @adapter: pointer to adapter
+ *
+ * This function restarts host TSF sync immediately after wlan resume
+ *
+ * Return: none
+ */
+void hdd_restart_tsf_sync_post_wlan_resume(struct hdd_adapter *adapter);
+
 /**
  * hdd_stop_tsf_sync() - stop tsf sync
  * @adapter: pointer to adapter
@@ -327,6 +337,11 @@ void hdd_update_dynamic_tsf_sync(struct hdd_adapter *adapter)
 {
 }
 
+static inline
+void hdd_restart_tsf_sync_post_wlan_resume(struct hdd_adapter *adapter)
+{
+}
+
 static inline
 QDF_STATUS hdd_get_tsf_time(void *adapter_ctx, uint64_t input_time,
 			    uint64_t *tsf_time)

core/hdd/src/wlan_hdd_power.c

@@ -1758,6 +1758,7 @@ static int hdd_resume_wlan(void)
 		if (adapter->device_mode == QDF_STA_MODE)
 			status = hdd_disable_default_pkt_filters(adapter);
 
+		hdd_restart_tsf_sync_post_wlan_resume(adapter);
 		hdd_adapter_dev_put_debug(adapter, NET_DEV_HOLD_RESUME_WLAN);
 	}
 

core/hdd/src/wlan_hdd_tsf.c

@@ -923,11 +923,11 @@ static inline void hdd_reset_timestamps(struct hdd_adapter *adapter)
 
 /**
  * hdd_check_timestamp_status() - return the tstamp status
- *
  * @last_target_time: the last saved target time
  * @last_sync_time: the last saved sync time
- * @cur_target_time : new target time
- * @cur_sync_time : new sync time
+ * @cur_target_time: new target time
+ * @cur_sync_time: new sync time
+ * @force_sync: flag to force new timestamp-pair as valid
  *
  * This function check the new timstamp-pair(cur_host_time/cur_target_time)or
  * (cur_qtime_time/cur_target_time)
@@ -943,7 +943,8 @@ enum hdd_ts_status hdd_check_timestamp_status(
 		uint64_t last_target_time,
 		uint64_t last_sync_time,
 		uint64_t cur_target_time,
-		uint64_t cur_sync_time)
+		uint64_t cur_sync_time,
+		bool force_sync)
 {
 	uint64_t delta_ns, delta_target_time, delta_sync_time;
 
@@ -979,7 +980,7 @@ enum hdd_ts_status hdd_check_timestamp_status(
 			(delta_sync_time - delta_target_time));
 	hdd_warn("timestamps deviation - delta: %llu ns", delta_ns);
 	/* the deviation should be smaller than a threshold */
-	if (delta_ns > MAX_ALLOWED_DEVIATION_NS) {
+	if (!force_sync && delta_ns > MAX_ALLOWED_DEVIATION_NS) {
 		hdd_warn("Invalid timestamps - delta: %llu ns", delta_ns);
 		return HDD_TS_STATUS_INVALID;
 	}
@@ -1370,7 +1371,11 @@ static void hdd_update_timestamp(struct hdd_adapter *adapter)
 		  hdd_check_timestamp_status(adapter->last_target_time,
 					     adapter->last_tsf_sync_soc_time,
 					     adapter->cur_target_time,
-					     adapter->cur_tsf_sync_soc_time);
+					     adapter->cur_tsf_sync_soc_time,
+					     adapter->host_target_sync_force);
+	if (adapter->host_target_sync_force)
+		adapter->host_target_sync_force = false;
+
 	hdd_info("sync_status %d", sync_status);
 	switch (sync_status) {
 	case HDD_TS_STATUS_INVALID:
@@ -1527,10 +1532,15 @@ static void hdd_update_timestamp(struct hdd_adapter *adapter,
 	if (target_time > 0)
 		adapter->cur_target_time = target_time;
 
-	sync_status = hdd_check_timestamp_status(adapter->last_target_time,
-						 adapter->last_host_time,
-						 adapter->cur_target_time,
-						 adapter->cur_host_time);
+	sync_status =
+		  hdd_check_timestamp_status(adapter->last_target_time,
+					     adapter->last_host_time,
+					     adapter->cur_target_time,
+					     adapter->cur_host_time,
+					     adapter->host_target_sync_force);
+	if (adapter->host_target_sync_force)
+		adapter->host_target_sync_force = false;
+
 	hdd_info("sync_status %d", sync_status);
 	switch (sync_status) {
 	case HDD_TS_STATUS_INVALID:
@@ -1794,6 +1804,34 @@ int hdd_start_tsf_sync(struct hdd_adapter *adapter)
 		HDD_TSF_OP_SUCC) ? 0 : -EINVAL;
 }
 
+void hdd_restart_tsf_sync_post_wlan_resume(struct hdd_adapter *adapter)
+{
+	QDF_STATUS status;
+	qdf_mc_timer_t *sync_timer;
+
+	if (!hdd_get_th_sync_status(adapter)) {
+		hdd_err("Host TSF sync is not initialized!!");
+		return;
+	}
+
+	sync_timer = &adapter->host_target_sync_timer;
+	if (QDF_TIMER_STATE_RUNNING ==
+		qdf_mc_timer_get_current_state(sync_timer)) {
+		status = qdf_mc_timer_stop_sync(sync_timer);
+		if (status != QDF_STATUS_SUCCESS) {
+			hdd_err("Couldn't stop Host TSF sync running timer!!");
+			return;
+		}
+
+		adapter->host_target_sync_force = true;
+		status = qdf_mc_timer_start(sync_timer, 10);
+		if (status != QDF_STATUS_SUCCESS)
+			hdd_err("Host TSF sync timer restart failed");
+
+		hdd_debug("Host TSF sync timer restarted post wlan resume");
+	}
+}
+
 int hdd_stop_tsf_sync(struct hdd_adapter *adapter)
 {
 	enum hdd_tsf_op_result ret;