android_kernel_samsung_sm8650-modules/tools/linux/peerstats.c

/*
 * Copyright (c) 2019-2020 The Linux Foundation. All rights reserved.
 *
 * Permission to use, copy, modify, and/or distribute this software for
 * any purpose with or without fee is hereby granted, provided that the
 * above copyright notice and this permission notice appear in all
 * copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
 * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
 * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
 * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
 * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
 * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
 * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
 * PERFORMANCE OF THIS SOFTWARE.
 */

/**
 * file: peer rate statitistics application
 * This file provides framework to display peer rate statistics
 */
#include <netinet/in.h>
#include <arpa/inet.h>
#include <qcatools_lib.h>
#include <dp_rate_stats_pub.h>

#ifndef min
#define min(x, y) ((x) < (y) ? (x) : (y))
#else
#error confilicting defs of min
#endif

#define PRINT(fmt, ...) \
	do { \
		printf(fmt, ##__VA_ARGS__); \
		printf("\n"); \
	} while (0)

char interface[IFNAMSIZ];

static void dp_peer_rx_rate_stats_print(uint8_t *peer_mac,
					uint64_t peer_cookie,
					void *buffer,
					uint32_t buffer_len)
{
	int i = 0;
	struct wlan_rx_rate_stats *rx_stats;
	uint8_t is_lithium;
	uint8_t chain, max_chain, bw, max_bw;
	struct wlan_rx_rate_stats *tmp_rx_stats;;

	rx_stats = tmp_rx_stats = (struct wlan_rx_rate_stats *)buffer;
	PRINT("\n......................................");
	PRINT("......................................");
	PRINT("PEER %02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx\n",
	      peer_mac[0],
	      peer_mac[1],
	      peer_mac[2],
	      peer_mac[3],
	      peer_mac[4],
	      peer_mac[5]);
	PRINT("\tpeer cookie: %016"PRIx64"\n",
					(peer_cookie & 0xFFFFFFFF00000000) >>
					WLANSTATS_PEER_COOKIE_LSB);
	is_lithium =  (peer_cookie & WLANSTATS_COOKIE_PLATFORM_OFFSET)
					>> WLANSTATS_PEER_COOKIE_LSB;
	if (is_lithium) {
		max_chain = 8;
		max_bw = 8;
	} else {
		max_chain = 4;
		max_bw = 4;
	}
	PRINT("\n..............................................");
	PRINT("................................");
	PRINT("................................................");
	PRINT(".................................\n");
	PRINT("\tRx statistics:");
	PRINT(" %10s | %10s | %10s | %10s | %10s | %10s|",
	      "rate",
	      "rix",
	      "bytes",
	      "msdus",
	      "mpdus",
	      "ppdus");
	PRINT(" %10s | %10s | %10s |",
	      "retries",
	      "sgi",
	      "rssi\n");

	for (i = 0; i < WLANSTATS_CACHE_SIZE; i++) {
		if (rx_stats->rix != INVALID_CACHE_IDX) {
			PRINT(" %10u | %10u | %10u | %10u | %10u | %10u |",
			      rx_stats->rate,
			      GET_DP_PEER_STATS_RIX(rx_stats->rix),
			      rx_stats->num_bytes,
			      rx_stats->num_msdus,
			      rx_stats->num_mpdus,
			      rx_stats->num_ppdus);
			PRINT(" %10u | %10u | %10lu |\n",
			      rx_stats->num_retries,
			      rx_stats->num_sgi,
			      rx_stats->avg_rssi);
		}
		rx_stats = rx_stats + 1;
	}
	if (is_lithium) {
	PRINT("\n %10s | %10s | %10s | %10s | %10s |",
	      "rate",
	      "rssi 1 p20",
	      "rssi 1 e20",
	      "rssi 1 e40 low20",
	      "rssi 1 e40 high20");
	PRINT("\n            | %10s | %10s | %10s | %10s |",
	      "rssi 1 ext80 low20",
	      "rssi 1 ext80 low_high20",
	      "rssi 1 ext80 high_low20",
	      "rssi 1 ext80 high20");
	PRINT("\n            | %10s | %10s | %10s | %10s |",
	      "rssi 2 p20",
	      "rssi 2 e20",
	      "rssi 2 e40 low20",
	      "rssi 2 e40 high20");
	PRINT("\n            | %10s | %10s | %10s | %10s |",
	      "rssi 2 ext80 low20",
	      "rssi 2 ext80 low_high20",
	      "rssi 2 ext80 high_low20",
	      "rssi 2 ext80 high20");
	PRINT("\n            | %10s | %10s | %10s | %10s |",
	      "rssi 3 p20",
	      "rssi 3 e20",
	      "rssi 3 e40 low20",
	      "rssi 3 e40 high20");
	PRINT("\n            | %10s | %10s | %10s | %10s |",
	      "rssi 3 ext80 low20",
	      "rssi 3 ext80 low_high20",
	      "rssi 3 ext80 high_low20",
	      "rssi 3 ext80 high20");
	PRINT("\n            | %10s | %10s | %10s | %10s |",
	      "rssi 4 p20",
	      "rssi 4 e20",
	      "rssi 4 e40 low20",
	      "rssi 4 e40 high20");
	PRINT("\n            | %10s | %10s | %10s | %10s |",
	      "rssi 4 ext80 low20",
	      "rssi 4 ext80 low_high20",
	      "rssi 4 ext80 high_low20",
	      "rssi 4 ext80 high20");
	PRINT("\n            | %10s | %10s | %10s | %10s |",
	      "rssi 5 p20",
	      "rssi 5 e20",
	      "rssi 5 e40 low20",
	      "rssi 5 e40 high20");
	PRINT("\n            | %10s | %10s | %10s | %10s |",
	      "rssi 5 ext80 low20",
	      "rssi 5 ext80 low_high20",
	      "rssi 5 ext80 high_low20",
	      "rssi 5 ext80 high20");
	PRINT("\n            | %10s | %10s | %10s | %10s |",
	      "rssi 6 p20",
	      "rssi 6 e20",
	      "rssi 6 e40 low20",
	      "rssi 6 e40 high20");
	PRINT("\n            | %10s | %10s | %10s | %10s |",
	      "rssi 6 ext80 low20",
	      "rssi 6 ext80 low_high20",
	      "rssi 6 ext80 high_low20",
	      "rssi 6 ext80 high20");
	PRINT("\n            | %10s | %10s | %10s | %10s |",
	      "rssi 7 p20",
	      "rssi 7 e20",
	      "rssi 7 e40 low20",
	      "rssi 7 e40 high20");
	PRINT("\n            | %10s | %10s | %10s | %10s |",
	      "rssi 7 ext80 low20",
	      "rssi 7 ext80 low_high20",
	      "rssi 7 ext80 high_low20",
	      "rssi 7 ext80 high20");
	PRINT("\n            | %10s | %10s | %10s | %10s |",
	      "rssi 8 p20",
	      "rssi 8 e20",
	      "rssi 8 e40 low20",
	      "rssi 8 e40 high20");
	PRINT("\n            | %10s | %10s | %10s | %10s |\n\n\n",
	      "rssi 8 ext80 low20",
	      "rssi 8 ext80 low_high20",
	      "rssi 8 ext80 high_low20",
	      "rssi 8 ext80 high20");
	} else {
	PRINT("\n %10s | %10s | %10s | %10s | %10s |",
	      "rate",
	      "rssi 1 p20",
	      "rssi 1 e20",
	      "rssi 1 e40",
	      "rssi 1 e80");
	PRINT("            | %10s | %10s | %10s | %10s |",
	      "rssi 2 p20",
	      "rssi 2 e20",
	      "rssi 2 e40",
	      "rssi 2 e80");
	PRINT("            | %10s | %10s | %10s | %10s |",
	      "rssi 3 p20",
	      "rssi 3 e20",
	      "rssi 3 e40",
	      "rssi 3 e80");
	PRINT("            | %10s | %10s | %10s | %10s |\n\n\n",
	      "rssi 4 p20",
	      "rssi 4 e20",
	      "rssi 4 e40",
	      "rssi 4 e80");
	}
	for (i = 0; i < WLANSTATS_CACHE_SIZE; i++) {
		if (tmp_rx_stats->rix != INVALID_CACHE_IDX) {
			printf(" %10u |", tmp_rx_stats->rate);
			for (chain = 0; chain < max_chain; chain++) {
				for (bw = 0; bw < max_bw; bw++) {
					printf(" %10lu |",
					tmp_rx_stats->avg_rssi_ant[chain][bw]);
				}
				printf("            \n\t     ");
			}
			PRINT(" ");
		}
		tmp_rx_stats = tmp_rx_stats + 1;
	}
}

static void
dp_peer_tx_sojourn_stats_print(uint8_t *peer_mac,
			       uint64_t peer_cookie,
			       struct wlan_tx_sojourn_stats *sojourn_stats)
{
	uint8_t tid;

	PRINT("\n..........................................");
	PRINT("....................................");
	PRINT("....................................");
	PRINT(".........................................\n");
	PRINT("PEER %02hhx:%02hhx:%02hhx:%02hhx%02hhx:%02hhx\n",
	      peer_mac[0],
	      peer_mac[1],
	      peer_mac[2],
	      peer_mac[3],
	      peer_mac[4],
	      peer_mac[5]);
	PRINT("\tPEER Cookie: %016"PRIx64"\n", peer_cookie);
	PRINT("\n...........................................");
	PRINT("...................................");
	PRINT("..................................");
	PRINT("............................................");
	PRINT("\n\tSojourn statistics:\n");
	PRINT("\t\t%10s %10s %20s %20s\n", "tid", "ave", "sum", "num");

	for (tid = 0; tid < WLAN_DATA_TID_MAX; tid++) {
				/* change sum_sojourn_msdu data type to u64 */
		PRINT("\t\t%10d %10lu %20u %20u\n",
		      tid,
		      sojourn_stats->avg_sojourn_msdu[tid],
		      sojourn_stats->sum_sojourn_msdu[tid],
		      sojourn_stats->num_msdus[tid]);
	}
#ifdef __LP64__
	PRINT("sizeof(avg) : %"PRIu64,
#else
	PRINT("sizeof(avg) : %"PRIu32,
#endif
				sizeof(sojourn_stats->avg_sojourn_msdu[tid]));
	PRINT("\n...........................................");
	PRINT("...................................");
	PRINT("...................................");
	PRINT("...........................................\n");
}

static void dp_peer_tx_rate_stats_print(uint8_t *peer_mac,
					uint64_t peer_cookie,
					void *buffer,
					uint32_t buffer_len)
{
	int i = 0;
	struct wlan_tx_rate_stats *tx_stats;
	struct wlan_tx_sojourn_stats *sojourn_stats;

	if (buffer_len < (WLANSTATS_CACHE_SIZE *
			  sizeof(struct wlan_tx_rate_stats))
			  + sizeof(struct wlan_tx_sojourn_stats)) {
		PRINT("invalid buffer len, return");
		return;
	}
	tx_stats = (struct wlan_tx_rate_stats *)buffer;
	PRINT("\n...........................................");
	PRINT("...................................");
	PRINT("...................................");
	PRINT("...........................................\n");
	PRINT("PEER %02hhx:%02hhx:%02hhx:%02hhx%02hhx:%02hhx\n\n",
	      peer_mac[0],
	      peer_mac[1],
	      peer_mac[2],
	      peer_mac[3],
	      peer_mac[4],
	      peer_mac[5]);
	PRINT("\tPEER Cookie: %016"PRIx64, peer_cookie);
	PRINT("\n...........................................");
	PRINT("...................................");
	PRINT("...................................");
	PRINT("...........................................\n");
	PRINT("\tTx statistics:\n");
	PRINT("\t\t%10s | %10s | %10s | %10s | %10s",
	      "rate",
	      "rix",
	      "attempts",
	      "success",
	      "ppdus");
	PRINT(" %10s | %10s | %10s |",
	      "msdus",
	      "bytes",
	      "retries\n");

	for (i = 0; i < WLANSTATS_CACHE_SIZE; i++) {
		if (tx_stats->rix != INVALID_CACHE_IDX) {
			PRINT("\t\t%10u | %10u | %10u | %10u | %10u\n",
			      tx_stats->rate,
			      GET_DP_PEER_STATS_RIX(tx_stats->rix),
			      tx_stats->mpdu_attempts,
			      tx_stats->mpdu_success,
			      tx_stats->num_ppdus);
			PRINT(" %10u | %10u | %10u |\n",
			      tx_stats->num_msdus,
			      tx_stats->num_bytes,
			      tx_stats->num_retries);
		}
		tx_stats = tx_stats + 1;
	}

	sojourn_stats = (struct wlan_tx_sojourn_stats *)((uint8_t *)buffer
			 + (WLANSTATS_CACHE_SIZE *
			 sizeof(struct wlan_tx_rate_stats)));
	dp_peer_tx_sojourn_stats_print(peer_mac, peer_cookie, sojourn_stats);

	return;
}

static void dp_peer_tx_link_stats_print(uint8_t *peer_mac,
					uint64_t peer_cookie,
					void *buffer,
					uint32_t buffer_len)
{
	struct wlan_tx_link_stats *tx_stats;
	uint8_t is_lithium;

	is_lithium =  (peer_cookie & WLANSTATS_COOKIE_PLATFORM_OFFSET)
					>> WLANSTATS_PEER_COOKIE_LSB;

	if (!is_lithium) {
		PRINT("Not supported in non-lithium platforms\n");
		return;
	}

	if (buffer_len < sizeof(struct wlan_tx_link_stats)) {
		PRINT("invalid buffer len, return");
		return;
	}

	tx_stats = (struct wlan_tx_link_stats *)buffer;

	PRINT("\n\n");
	PRINT("========= PEER TX LINK QUALITY METRICS =========\n");
	PRINT("PEER %02hhx:%02hhx:%02hhx:%02hhx%02hhx:%02hhx",
	      peer_mac[0],
	      peer_mac[1],
	      peer_mac[2],
	      peer_mac[3],
	      peer_mac[4],
	      peer_mac[5]);
	PRINT("num_ppdus: %u", tx_stats->num_ppdus);
	PRINT("bytes: %"PRIu64, tx_stats->bytes);
	PRINT("phy_rate_actual_su: %u kbps", tx_stats->phy_rate_actual_su);
	PRINT("phy_rate_actual_mu: %u kbps", tx_stats->phy_rate_actual_mu);
	PRINT("ofdma_usage: %u", tx_stats->ofdma_usage);
	PRINT("mu_mimo_usage: %u", tx_stats->mu_mimo_usage);
	PRINT("bw_usage_avg: %u MHz", tx_stats->bw.usage_avg);
	PRINT("bw_usage_packets: 20MHz: %u 40MHz: %u 80MHz: %u 160MHz: %u",
	      tx_stats->bw.usage_counter[0], tx_stats->bw.usage_counter[1],
	      tx_stats->bw.usage_counter[2], tx_stats->bw.usage_counter[3]);
	PRINT("bw_usage_max:: %u%%", tx_stats->bw.usage_max);
	PRINT("ack_rssi: %lu", tx_stats->ack_rssi);
	PRINT("pkt_error_rate: %u%%", tx_stats->pkt_error_rate);
}

static void dp_peer_rx_link_stats_print(uint8_t *peer_mac,
					uint64_t peer_cookie,
					void *buffer,
					uint32_t buffer_len)
{
	struct wlan_rx_link_stats *rx_stats;
	uint8_t is_lithium;

	is_lithium =  (peer_cookie & WLANSTATS_COOKIE_PLATFORM_OFFSET)
					>> WLANSTATS_PEER_COOKIE_LSB;

	if (!is_lithium) {
		PRINT("Not supported in non-lithium platforms\n");
		return;
	}

	if (buffer_len < sizeof(struct wlan_rx_link_stats)) {
		PRINT("invalid buffer len, return");
		return;
	}

	rx_stats = (struct wlan_rx_link_stats *)buffer;

	PRINT("\n\n");
	PRINT("========= PEER RX LINK QUALITY METRICS =========\n");
	PRINT("PEER %02hhx:%02hhx:%02hhx:%02hhx%02hhx:%02hhx",
	      peer_mac[0],
	      peer_mac[1],
	      peer_mac[2],
	      peer_mac[3],
	      peer_mac[4],
	      peer_mac[5]);
	PRINT("num_ppdus: %u", rx_stats->num_ppdus);
	PRINT("bytes: %"PRIu64, rx_stats->bytes);
	PRINT("phy_rate_actual_su: %u kbps", rx_stats->phy_rate_actual_su);
	PRINT("phy_rate_actual_mu: %u kbps", rx_stats->phy_rate_actual_mu);
	PRINT("ofdma_usage: %u", rx_stats->ofdma_usage);
	PRINT("mu_mimo_usage: %u", rx_stats->mu_mimo_usage);
	PRINT("bw_usage_avg: %u MHz", rx_stats->bw.usage_avg);
	PRINT("bw_usage_packets: 20MHz: %u 40MHz: %u 80MHz: %u 160MHz: %u",
	      rx_stats->bw.usage_counter[0], rx_stats->bw.usage_counter[1],
	      rx_stats->bw.usage_counter[2], rx_stats->bw.usage_counter[3]);
	PRINT("bw_usage_max: %u%%", rx_stats->bw.usage_max);
	PRINT("su_rssi: %lu", rx_stats->su_rssi);
	PRINT("pkt_error_rate: %u%%", rx_stats->pkt_error_rate);
}

static void dp_peer_stats_handler(uint32_t cache_type,
				 uint8_t *peer_mac,
				 uint64_t peer_cookie,
				 void *buffer,
				 uint32_t buffer_len)
{
	switch (cache_type) {
	case DP_PEER_RX_RATE_STATS:
		dp_peer_rx_rate_stats_print(peer_mac, peer_cookie,
					    buffer, buffer_len);
		break;
	case DP_PEER_TX_RATE_STATS:
		dp_peer_tx_rate_stats_print(peer_mac, peer_cookie,
					    buffer, buffer_len);
		break;
	case DP_PEER_TX_LINK_STATS:
		dp_peer_tx_link_stats_print(peer_mac, peer_cookie,
					    buffer, buffer_len);
		break;
	case DP_PEER_RX_LINK_STATS:
		dp_peer_rx_link_stats_print(peer_mac, peer_cookie,
					    buffer, buffer_len);
		break;
	}
}

static void
dp_peer_stats_event_callback(char *ifname,
			     uint32_t cmdid,
			     uint8_t *data,
			     size_t len)
{
	struct nlattr *tb_array[QCA_WLAN_VENDOR_ATTR_PEER_STATS_CACHE_MAX + 1];
	struct nlattr *tb;
	void *buffer = NULL;
	uint32_t buffer_len = 0;
	uint8_t *peer_mac;
	uint32_t cache_type;
	uint64_t peer_cookie;

	if (cmdid != QCA_NL80211_VENDOR_SUBCMD_PEER_STATS_CACHE_FLUSH) {
		/* ignore anyother events*/
		return;
	}

	if (strncmp(interface, ifname, sizeof(interface)) != 0) {
		/* ignore events for other interfaces*/
		return;
	}

	if (nla_parse(tb_array, QCA_WLAN_VENDOR_ATTR_PEER_STATS_CACHE_MAX,
		      (struct nlattr *)data, len, NULL)) {
		PRINT("Invalid event\n");
		return;
	}

	tb = tb_array[QCA_WLAN_VENDOR_ATTR_PEER_STATS_CACHE_TYPE];
	if (!tb) {
		PRINT("Cache type in NULL, return");
		return;
	}
	cache_type = nla_get_u32(tb);

	tb = tb_array[QCA_WLAN_VENDOR_ATTR_PEER_STATS_CACHE_PEER_MAC];
	if (!tb) {
		PRINT("Peer mac addr is null, return");
		return;
	}
	peer_mac = (uint8_t *)nla_data(tb);

	tb = tb_array[QCA_WLAN_VENDOR_ATTR_PEER_STATS_CACHE_DATA];
	if (tb) {
		buffer = (void *)nla_data(tb);
		buffer_len = nla_len(tb);
	}

	tb = tb_array[QCA_WLAN_VENDOR_ATTR_PEER_STATS_CACHE_PEER_COOKIE];
	if (!tb) {
		PRINT("peer cookie attribute is null, return");
		return;
	}
	peer_cookie = nla_get_u64(tb);
	if (!buffer) {
		PRINT(" stats buffer is null, return");
		return;
	}

	dp_peer_stats_handler(cache_type, peer_mac, peer_cookie,
			      buffer, buffer_len);
}

int main(int argc, char *argv[])
{
	int err = 0;
	wifi_cfg80211_context cfg80211_ctxt;
	char *ifname;
	int num_msecs = 0;
	int status = 0;

	if (argc < 2) {
		fprintf(stderr, "Invalid commands args\n");
		return -EIO;
	}

	/* Reset the cfg80211 context to 0 if the application does not pass
	 * custom private event and command sockets. In this case, the default
	 * port is used for netlink communication.
	 */
	memset(&cfg80211_ctxt, 0, sizeof(wifi_cfg80211_context));

	ifname = argv[1];
	memcpy(interface, ifname, sizeof(interface));
	cfg80211_ctxt.event_callback = dp_peer_stats_event_callback;

	err = wifi_init_nl80211(&cfg80211_ctxt);
	if (err) {
		fprintf(stderr, "unable to create NL socket\n");
		return -EIO;
	}

	/* Starting event thread to listen for responses*/
	if (wifi_nl80211_start_event_thread(&cfg80211_ctxt)) {
		fprintf(stderr, "Unable to setup nl80211 event thread\n");
		status = -EIO;
		goto cleanup;
	}

	while (true) {
		/*sleep for 1 ms*/
		usleep(1000);
		num_msecs++;
	}

	wifi_destroy_nl80211(&cfg80211_ctxt);
	return 0;

cleanup:
	wifi_destroy_nl80211(&cfg80211_ctxt);
	return status;
}