1 /* 2 * Copyright (c) 2020, The Linux Foundation. All rights reserved. 3 * 4 * Permission to use, copy, modify, and/or distribute this software for any 5 * purpose with or without fee is hereby granted, provided that the above 6 * copyright notice and this permission notice appear in all copies. 7 * 8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 11 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 13 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 14 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 15 */ 16 #include <qdf_hang_event_notifier.h> 17 #include <qdf_notifier.h> 18 #include <wmi_hang_event.h> 19 #include <wmi_unified_priv.h> 20 #include <qdf_trace.h> 21 22 struct wmi_hang_data_fixed_param { 23 uint16_t tlv_header; /* tlv tag and length */ 24 uint32_t event; 25 uint32_t data; 26 uint64_t time; 27 } qdf_packed; 28 29 #define WMI_EVT_HIST 0 30 #define WMI_CMD_HIST 1 31 #define NUM_HANG_WMI_HISTORY 1 32 33 static void wmi_log_history(struct notifier_block *block, void *data, 34 uint8_t wmi_history) 35 { 36 qdf_notif_block *notif_block = qdf_container_of(block, qdf_notif_block, 37 notif_block); 38 struct qdf_notifer_data *wmi_hang_data = data; 39 int nread, pos, total_len; 40 unsigned int wmi_ring_size = NUM_HANG_WMI_HISTORY; 41 uint64_t secs, usecs; 42 struct wmi_event_debug *wmi_evt; 43 struct wmi_unified *wmi_handle; 44 struct wmi_log_buf_t *wmi_log; 45 struct wmi_hang_data_fixed_param *cmd; 46 struct wmi_command_debug *wmi_cmd; 47 uint8_t *wmi_buf_ptr; 48 49 if (!wmi_hang_data) 50 return; 51 52 wmi_handle = notif_block->priv_data; 53 if (!wmi_handle) 54 return; 55 56 if (wmi_history) 57 wmi_log = &wmi_handle->log_info.wmi_event_log_buf_info; 58 else 59 wmi_log = &wmi_handle->log_info.wmi_command_log_buf_info; 60 61 total_len = sizeof(struct wmi_hang_data_fixed_param); 62 63 if (wmi_log->length <= wmi_ring_size) 64 nread = wmi_log->length; 65 else 66 nread = wmi_ring_size; 67 68 if (*wmi_log->p_buf_tail_idx == 0) 69 /* tail can be 0 after wrap-around */ 70 pos = wmi_ring_size - 1; 71 else 72 pos = *wmi_log->p_buf_tail_idx - 1; 73 74 while (nread--) { 75 if (wmi_hang_data->offset + total_len > QDF_WLAN_HANG_FW_OFFSET) 76 return; 77 78 switch (wmi_history) { 79 case WMI_EVT_HIST: 80 wmi_buf_ptr = (wmi_hang_data->hang_data + 81 wmi_hang_data->offset); 82 cmd = ((struct wmi_hang_data_fixed_param *)wmi_buf_ptr); 83 QDF_HANG_EVT_SET_HDR(&cmd->tlv_header, 84 HANG_EVT_TAG_WMI_EVT_HIST, 85 QDF_HANG_GET_STRUCT_TLVLEN(struct wmi_hang_data_fixed_param)); 86 wmi_evt = &(((struct wmi_event_debug *)wmi_log->buf)[pos]); 87 cmd->event = wmi_evt->event; 88 qdf_log_timestamp_to_secs(wmi_evt->time, &secs, &usecs); 89 cmd->time = secs; 90 cmd->data = wmi_evt->data[0]; 91 break; 92 case WMI_CMD_HIST: 93 wmi_buf_ptr = (wmi_hang_data->hang_data + 94 wmi_hang_data->offset); 95 cmd = ((struct wmi_hang_data_fixed_param *)wmi_buf_ptr); 96 QDF_HANG_EVT_SET_HDR(&cmd->tlv_header, 97 HANG_EVT_TAG_WMI_CMD_HIST, 98 QDF_HANG_GET_STRUCT_TLVLEN(struct wmi_hang_data_fixed_param)); 99 wmi_cmd = &(((struct wmi_command_debug *)wmi_log->buf)[pos]); 100 cmd->event = wmi_cmd->command; 101 qdf_log_timestamp_to_secs(wmi_cmd->time, &secs, &usecs); 102 cmd->time = secs; 103 cmd->data = wmi_cmd->data[0]; 104 break; 105 } 106 if (pos == 0) 107 pos = wmi_ring_size - 1; 108 else 109 pos--; 110 wmi_hang_data->offset += total_len; 111 } 112 } 113 114 static int wmi_recovery_notifier_call(struct notifier_block *block, 115 unsigned long state, 116 void *data) 117 { 118 wmi_log_history(block, data, WMI_EVT_HIST); 119 wmi_log_history(block, data, WMI_CMD_HIST); 120 121 return NOTIFY_OK; 122 } 123 124 static qdf_notif_block wmi_recovery_notifier = { 125 .notif_block.notifier_call = wmi_recovery_notifier_call, 126 }; 127 128 QDF_STATUS wmi_hang_event_notifier_register(struct wmi_unified *wmi_hdl) 129 { 130 wmi_recovery_notifier.priv_data = wmi_hdl; 131 return qdf_hang_event_register_notifier(&wmi_recovery_notifier); 132 } 133 134 QDF_STATUS wmi_hang_event_notifier_unregister(void) 135 { 136 return qdf_hang_event_unregister_notifier(&wmi_recovery_notifier); 137 } 138