peerstats.c 10 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364
  1. /*
  2. * Copyright (c) 2019 The Linux Foundation. All rights reserved.
  3. *
  4. * Permission to use, copy, modify, and/or distribute this software for
  5. * any purpose with or without fee is hereby granted, provided that the
  6. * above copyright notice and this permission notice appear in all
  7. * copies.
  8. *
  9. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
  10. * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
  11. * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
  12. * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
  13. * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
  14. * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
  15. * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
  16. * PERFORMANCE OF THIS SOFTWARE.
  17. */
  18. /**
  19. * file: peer rate statitistics application
  20. * This file provides framework to display peer rate statistics
  21. */
  22. #include <netinet/in.h>
  23. #include <arpa/inet.h>
  24. #include <qcatools_lib.h>
  25. #include <dp_rate_stats_pub.h>
  26. #ifndef min
  27. #define min(x, y) ((x) < (y) ? (x) : (y))
  28. #else
  29. #error confilicting defs of min
  30. #endif
  31. #define PRINT(fmt, ...) \
  32. do { \
  33. printf(fmt, ##__VA_ARGS__); \
  34. printf("\n"); \
  35. } while (0)
  36. char interface[IFNAMSIZ];
  37. static void dp_peer_rx_rate_stats_print(uint8_t *peer_mac,
  38. uint64_t peer_cookie,
  39. void *buffer,
  40. uint32_t buffer_len)
  41. {
  42. int i = 0;
  43. struct wlan_rx_rate_stats *rx_stats;
  44. rx_stats = (struct wlan_rx_rate_stats *)buffer;
  45. PRINT("\n......................................");
  46. PRINT("......................................");
  47. PRINT("PEER %02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx\n",
  48. peer_mac[0],
  49. peer_mac[1],
  50. peer_mac[2],
  51. peer_mac[3],
  52. peer_mac[4],
  53. peer_mac[5]);
  54. PRINT("\tpeer cookie: %016llx\n", peer_cookie);
  55. PRINT("\n..............................................");
  56. PRINT("................................");
  57. PRINT("................................................");
  58. PRINT(".................................\n");
  59. PRINT("\tRx statistics:");
  60. PRINT(" %10s | %10s | %10s | %10s | %10s | %10s",
  61. "rate",
  62. "rix",
  63. "bytes",
  64. "msdus",
  65. "mpdus",
  66. "ppdus");
  67. PRINT("\t\t%10s | %10s | %10s | %10s | %10s | %10s |",
  68. "retries",
  69. "rssi",
  70. "rssi 1 p20",
  71. "rssi 1 e20",
  72. "rssi 1 e40",
  73. "rssi 1 e80");
  74. PRINT(" | %10s | | %10s | %10s | %10s | %10s | %10s",
  75. "rssi 2 p20",
  76. "rssi 2 e20",
  77. "rssi 2 e40",
  78. "rssi 2 e80",
  79. "rssi 3 p20",
  80. "rssi 3 e20");
  81. PRINT(" | %10s | %10s | %10s | %10s | %10s | %10s\n\n\n",
  82. "rssi 3 e40",
  83. "rssi 3 e80",
  84. "rssi 4 p20",
  85. "rssi 4 e20",
  86. "rssi 4 e40",
  87. "rssi 4 e80");
  88. for (i = 0; i < WLANSTATS_CACHE_SIZE; i++) {
  89. if (rx_stats->rix != INVALID_CACHE_IDX) {
  90. PRINT(" %10u | %10u | %10u | %10u | %10u |",
  91. rx_stats->rate,
  92. rx_stats->rix,
  93. rx_stats->num_bytes,
  94. rx_stats->num_msdus,
  95. rx_stats->num_mpdus);
  96. PRINT(" %10u | %10u | %10u | %10lu | %10lu |",
  97. rx_stats->num_ppdus,
  98. rx_stats->num_retries,
  99. rx_stats->num_sgi,
  100. rx_stats->avg_rssi,
  101. rx_stats->avg_rssi_ant[0][0]);
  102. PRINT(" %10lu | %10lu | %10lu | %10lu | %10lu |",
  103. rx_stats->avg_rssi_ant[0][1],
  104. rx_stats->avg_rssi_ant[0][2],
  105. rx_stats->avg_rssi_ant[0][3],
  106. rx_stats->avg_rssi_ant[1][0],
  107. rx_stats->avg_rssi_ant[1][1]);
  108. PRINT(" %10lu | %10lu | %10lu | %10lu | %10lu |",
  109. rx_stats->avg_rssi_ant[1][2],
  110. rx_stats->avg_rssi_ant[1][3],
  111. rx_stats->avg_rssi_ant[2][0],
  112. rx_stats->avg_rssi_ant[2][1],
  113. rx_stats->avg_rssi_ant[2][2]);
  114. PRINT(" %10lu | %10lu | %10lu | %10lu | %10lu\n\n\n",
  115. rx_stats->avg_rssi_ant[2][3],
  116. rx_stats->avg_rssi_ant[3][0],
  117. rx_stats->avg_rssi_ant[3][1],
  118. rx_stats->avg_rssi_ant[3][2],
  119. rx_stats->avg_rssi_ant[3][3]);
  120. }
  121. rx_stats = rx_stats + 1;
  122. }
  123. }
  124. static void
  125. dp_peer_tx_sojourn_stats_print(uint8_t *peer_mac,
  126. uint64_t peer_cookie,
  127. struct wlan_tx_sojourn_stats *sojourn_stats)
  128. {
  129. uint8_t tid;
  130. PRINT("\n..........................................");
  131. PRINT("....................................");
  132. PRINT("....................................");
  133. PRINT(".........................................\n");
  134. PRINT("PEER %02hhx:%02hhx:%02hhx:%02hhx%02hhx:%02hhx\n",
  135. peer_mac[0],
  136. peer_mac[1],
  137. peer_mac[2],
  138. peer_mac[3],
  139. peer_mac[4],
  140. peer_mac[5]);
  141. PRINT("\tPEER Cookie: %016llx\n", peer_cookie);
  142. PRINT("\n...........................................");
  143. PRINT("...................................");
  144. PRINT("..................................");
  145. PRINT("............................................");
  146. PRINT("\n\tSojourn statistics:\n");
  147. PRINT("\t\t%10s %10s %20s %20s\n", "tid", "ave", "sum", "num");
  148. for (tid = 0; tid < WLAN_DATA_TID_MAX; tid++) {
  149. /* change sum_sojourn_msdu data type to u64 */
  150. PRINT("\t\t%10d %10lu %20u %20u\n",
  151. tid,
  152. sojourn_stats->avg_sojourn_msdu[tid],
  153. sojourn_stats->sum_sojourn_msdu[tid],
  154. sojourn_stats->num_msdus[tid]);
  155. }
  156. PRINT("sizeof(avg): %d", sizeof(sojourn_stats->avg_sojourn_msdu[tid]));
  157. PRINT("\n...........................................");
  158. PRINT("...................................");
  159. PRINT("...................................");
  160. PRINT("...........................................\n");
  161. }
  162. static void dp_peer_tx_rate_stats_print(uint8_t *peer_mac,
  163. uint64_t peer_cookie,
  164. void *buffer,
  165. uint32_t buffer_len)
  166. {
  167. int i = 0;
  168. struct wlan_tx_rate_stats *tx_stats;
  169. struct wlan_tx_sojourn_stats *sojourn_stats;
  170. if (buffer_len < (WLANSTATS_CACHE_SIZE *
  171. sizeof(struct wlan_tx_rate_stats))
  172. + sizeof(struct wlan_tx_sojourn_stats)) {
  173. PRINT("invalid buffer len, return");
  174. return;
  175. }
  176. tx_stats = (struct wlan_tx_rate_stats *)buffer;
  177. PRINT("\n...........................................");
  178. PRINT("...................................");
  179. PRINT("...................................");
  180. PRINT("...........................................\n");
  181. PRINT("PEER %02hhx:%02hhx:%02hhx:%02hhx%02hhx:%02hhx\n\n",
  182. peer_mac[0],
  183. peer_mac[1],
  184. peer_mac[2],
  185. peer_mac[3],
  186. peer_mac[4],
  187. peer_mac[5]);
  188. PRINT("\tPEER Cookie: %016llx", peer_cookie);
  189. PRINT("\n...........................................");
  190. PRINT("...................................");
  191. PRINT("...................................");
  192. PRINT("...........................................\n");
  193. PRINT("\tTx statistics:\n");
  194. PRINT("\t\t%10s | %10s | %10s | %10s | %10s",
  195. "rate",
  196. "rix",
  197. "attempts",
  198. "success",
  199. "ppdus");
  200. for (i = 0; i < WLANSTATS_CACHE_SIZE; i++) {
  201. if (tx_stats->rix != INVALID_CACHE_IDX) {
  202. PRINT("\t\t%10u | %10u | %10u | %10u | %10u\n",
  203. tx_stats->rate,
  204. tx_stats->rix,
  205. tx_stats->mpdu_attempts,
  206. tx_stats->mpdu_success,
  207. tx_stats->num_ppdus);
  208. }
  209. tx_stats = tx_stats + 1;
  210. }
  211. sojourn_stats = (struct wlan_tx_sojourn_stats *)((uint8_t *)buffer
  212. + (WLANSTATS_CACHE_SIZE *
  213. sizeof(struct wlan_tx_rate_stats)));
  214. dp_peer_tx_sojourn_stats_print(peer_mac, peer_cookie, sojourn_stats);
  215. return;
  216. }
  217. static void dp_peer_stats_handler(uint32_t cache_type,
  218. uint8_t *peer_mac,
  219. uint64_t peer_cookie,
  220. void *buffer,
  221. uint32_t buffer_len)
  222. {
  223. switch (cache_type) {
  224. case DP_PEER_RX_RATE_STATS:
  225. dp_peer_rx_rate_stats_print(peer_mac, peer_cookie,
  226. buffer, buffer_len);
  227. break;
  228. case DP_PEER_TX_RATE_STATS:
  229. dp_peer_tx_rate_stats_print(peer_mac, peer_cookie,
  230. buffer, buffer_len);
  231. break;
  232. }
  233. }
  234. static void
  235. dp_peer_stats_event_callback(char *ifname,
  236. uint32_t cmdid,
  237. uint8_t *data,
  238. size_t len)
  239. {
  240. struct nlattr *tb_array[QCA_WLAN_VENDOR_ATTR_PEER_STATS_CACHE_MAX + 1];
  241. struct nlattr *tb;
  242. void *buffer = NULL;
  243. uint32_t buffer_len = 0;
  244. uint8_t *peer_mac;
  245. uint32_t cache_type;
  246. uint64_t peer_cookie;
  247. if (cmdid != QCA_NL80211_VENDOR_SUBCMD_PEER_STATS_CACHE_FLUSH) {
  248. /* ignore anyother events*/
  249. return;
  250. }
  251. if (strncmp(interface, ifname, sizeof(interface)) != 0) {
  252. /* ignore events for other interfaces*/
  253. return;
  254. }
  255. if (nla_parse(tb_array, QCA_WLAN_VENDOR_ATTR_PEER_STATS_CACHE_MAX,
  256. (struct nlattr *)data, len, NULL)) {
  257. PRINT("Invalid event\n");
  258. return;
  259. }
  260. tb = tb_array[QCA_WLAN_VENDOR_ATTR_PEER_STATS_CACHE_TYPE];
  261. if (!tb) {
  262. PRINT("Cache type in NULL, return");
  263. return;
  264. }
  265. cache_type = nla_get_u32(tb);
  266. tb = tb_array[QCA_WLAN_VENDOR_ATTR_PEER_STATS_CACHE_PEER_MAC];
  267. if (!tb) {
  268. PRINT("Peer mac addr is null, return");
  269. return;
  270. }
  271. peer_mac = (uint8_t *)nla_data(tb);
  272. tb = tb_array[QCA_WLAN_VENDOR_ATTR_PEER_STATS_CACHE_DATA];
  273. if (tb) {
  274. buffer = (void *)nla_data(tb);
  275. buffer_len = nla_len(tb);
  276. }
  277. tb = tb_array[QCA_WLAN_VENDOR_ATTR_PEER_STATS_CACHE_PEER_COOKIE];
  278. if (!tb) {
  279. PRINT("peer cookie attribute is null, return");
  280. return;
  281. }
  282. peer_cookie = nla_get_u64(tb);
  283. if (!buffer) {
  284. PRINT(" stats buffer is null, return");
  285. return;
  286. }
  287. dp_peer_stats_handler(cache_type, peer_mac, peer_cookie,
  288. buffer, buffer_len);
  289. }
  290. int main(int argc, char *argv[])
  291. {
  292. int err = 0;
  293. wifi_cfg80211_context cfg80211_ctxt;
  294. char *ifname;
  295. int num_msecs = 0;
  296. int status = 0;
  297. if (argc < 2) {
  298. fprintf(stderr, "Invalid commands args\n");
  299. return -EIO;
  300. }
  301. /* Reset the cfg80211 context to 0 if the application does not pass
  302. * custom private event and command sockets. In this case, the default
  303. * port is used for netlink communication.
  304. */
  305. memset(&cfg80211_ctxt, 0, sizeof(wifi_cfg80211_context));
  306. ifname = argv[1];
  307. memcpy(interface, ifname, sizeof(interface));
  308. cfg80211_ctxt.event_callback = dp_peer_stats_event_callback;
  309. err = wifi_init_nl80211(&cfg80211_ctxt);
  310. if (err) {
  311. fprintf(stderr, "unable to create NL socket\n");
  312. return -EIO;
  313. }
  314. /* Starting event thread to listen for responses*/
  315. if (wifi_nl80211_start_event_thread(&cfg80211_ctxt)) {
  316. fprintf(stderr, "Unable to setup nl80211 event thread\n");
  317. status = -EIO;
  318. goto cleanup;
  319. }
  320. while (true) {
  321. /*sleep for 1 ms*/
  322. usleep(1000);
  323. num_msecs++;
  324. }
  325. wifi_destroy_nl80211(&cfg80211_ctxt);
  326. return 0;
  327. cleanup:
  328. wifi_destroy_nl80211(&cfg80211_ctxt);
  329. return status;
  330. }