iwlwifi: mvm: add trigger for time events

This will allow to collect data when a time event
notifcation with a certain id and action is coming from
the firmware. This can be very useful to debug various
flows.

Reviewed-by: Johannes Berg <johannes.berg@intel.com>
Signed-off-by: Emmanuel Grumbach <emmanuel.grumbach@intel.com>

1 files changed, 42 insertions, 0 deletions

diff --git a/drivers/net/wireless/iwlwifi/mvm/time-event.c b/drivers/net/wireless/iwlwifi/mvm/time-event.c
index bd519597eb2d..647822366fe5 100644
--- a/drivers/net/wireless/iwlwifi/mvm/time-event.c
+++ b/drivers/net/wireless/iwlwifi/mvm/time-event.c
@@ -226,6 +226,44 @@ iwl_mvm_te_handle_notify_csa(struct iwl_mvm *mvm,
         iwl_mvm_te_clear_data(mvm, te_data);
 }
 
+static void iwl_mvm_te_check_trigger(struct iwl_mvm *mvm,
+                                     struct iwl_time_event_notif *notif,
+                                     struct iwl_mvm_time_event_data *te_data)
+{
+        struct iwl_fw_dbg_trigger_tlv *trig;
+        struct iwl_fw_dbg_trigger_time_event *te_trig;
+        int i;
+
+        if (!iwl_fw_dbg_trigger_enabled(mvm->fw, FW_DBG_TRIGGER_TIME_EVENT))
+                return;
+
+        trig = iwl_fw_dbg_get_trigger(mvm->fw, FW_DBG_TRIGGER_TIME_EVENT);
+        te_trig = (void *)trig->data;
+
+        if (!iwl_fw_dbg_trigger_check_stop(mvm, te_data->vif, trig))
+                return;
+
+        for (i = 0; i < ARRAY_SIZE(te_trig->time_events); i++) {
+                u32 trig_te_id = le32_to_cpu(te_trig->time_events[i].id);
+                u32 trig_action_bitmap =
+                        le32_to_cpu(te_trig->time_events[i].action_bitmap);
+                u32 trig_status_bitmap =
+                        le32_to_cpu(te_trig->time_events[i].status_bitmap);
+
+                if (trig_te_id != te_data->id ||
+                    !(trig_action_bitmap & le32_to_cpu(notif->action)) ||
+                    !(trig_status_bitmap & BIT(le32_to_cpu(notif->status))))
+                        continue;
+
+                iwl_mvm_fw_dbg_collect_trig(mvm, trig,
+                                            "Time event %d Action 0x%x received status: %d",
+                                            te_data->id,
+                                            le32_to_cpu(notif->action),
+                                            le32_to_cpu(notif->status));
+                break;
+        }
+}
+
 /*
  * Handles a FW notification for an event that is known to the driver.
  *
@@ -243,6 +281,8 @@ static void iwl_mvm_te_handle_notif(struct iwl_mvm *mvm,
                      le32_to_cpu(notif->unique_id),
                      le32_to_cpu(notif->action));
 
+        iwl_mvm_te_check_trigger(mvm, notif, te_data);
+
         /*
          * The FW sends the start/end time event notifications even for events
          * that it fails to schedule. This is indicated in the status field of
@@ -324,6 +364,8 @@ static int iwl_mvm_aux_roc_te_handle_notif(struct iwl_mvm *mvm,
         if (!aux_roc_te) /* Not a Aux ROC time event */
                 return -EINVAL;
 
+        iwl_mvm_te_check_trigger(mvm, notif, te_data);
+
         if (!le32_to_cpu(notif->status)) {
                 IWL_DEBUG_TE(mvm,
                              "ERROR: Aux ROC Time Event %s notification failure\n",