iwlwifi: mvm: Add debugfs function for clocks diff

New function, reveals the diff between gp2 and host time.

Signed-off-by: Roee Zamir <roee.zamir@intel.com>
Signed-off-by: Luca Coelho <luciano.coelho@intel.com>

1 files changed, 22 insertions, 0 deletions

diff --git a/drivers/net/wireless/intel/iwlwifi/mvm/utils.c b/drivers/net/wireless/intel/iwlwifi/mvm/utils.c
index 7c138fedcb19..9e366e28c983 100644
--- a/drivers/net/wireless/intel/iwlwifi/mvm/utils.c
+++ b/drivers/net/wireless/intel/iwlwifi/mvm/utils.c
@@ -1225,6 +1225,28 @@ void iwl_mvm_inactivity_check(struct iwl_mvm *mvm)
         rcu_read_unlock();
 }
 
+void iwl_mvm_get_sync_time(struct iwl_mvm *mvm, u32 *gp2, u64 *boottime)
+{
+        bool ps_disabled;
+
+        lockdep_assert_held(&mvm->mutex);
+
+        /* Disable power save when reading GP2 */
+        ps_disabled = mvm->ps_disabled;
+        if (!ps_disabled) {
+                mvm->ps_disabled = true;
+                iwl_mvm_power_update_device(mvm);
+        }
+
+        *gp2 = iwl_read_prph(mvm->trans, DEVICE_SYSTEM_TIME_REG);
+        *boottime = ktime_get_boot_ns();
+
+        if (!ps_disabled) {
+                mvm->ps_disabled = ps_disabled;
+                iwl_mvm_power_update_device(mvm);
+        }
+}
+
 int iwl_mvm_send_lqm_cmd(struct ieee80211_vif *vif,
                          enum iwl_lqm_cmd_operatrions operation,
                          u32 duration, u32 timeout)