new/kernel-rt/drivers/net/wireless/rockchip_wlan/uwe5621ds/unisocwifi/tracer.c

/* SPDX-License-Identifier: GPL-2.0 */
#include <linux/etherdevice.h>
#include <linux/ipv6.h>
#include <linux/ip.h>
#include <net/ndisc.h>
#include <linux/suspend.h>
#include <linux/workqueue.h>
#include <linux/kallsyms.h>
#include "msg.h"
#include "tracer.h"
#include "cmdevt.h"
#include "rx_msg.h"

#define WAKEUP_TIME_EXPIRED 500

static struct deauth_trace deauth;
static void deauth_reason_worker(struct work_struct *work);
static DECLARE_WORK(deauth_worker, deauth_reason_worker);

static void deauth_reason_worker(struct work_struct *work)
{
	int i, j;
	struct deauth_info *dinfo;

	wl_info("deauth reason dump: == START ==\n");
	for (i = 0; i < SPRDWL_MODE_MAX; i++) {
		for (j = 0; j < MAX_DEAUTH_REASON; j++) {
			dinfo = &deauth.deauth_mode[i];
			if (dinfo->local_deauth[j] != 0)
				wl_info("mode[%d] local reason[%d]:%ld times\n",
					i, j, dinfo->local_deauth[j]);

			if (dinfo->remote_deauth[j] != 0)
				wl_info("mode[%d] remote reason[%d]:%ld times\n",
					i, j, dinfo->remote_deauth[j]);
		}
	}

	wl_info("deauth reason dump: == END ==\n");
}

void trace_deauth_reason(int mode, u16 reason_code, int dirction)
{
	struct deauth_info *dinfo;

	if (reason_code > MAX_DEAUTH_REASON) {
		wl_info("deauth reason:%d not record\n", reason_code);
		return;
	}

	dinfo = &deauth.deauth_mode[mode];
	spin_lock_bh(&deauth.lock);
	switch (dirction) {
	case LOCAL_EVENT:
		dinfo->local_deauth[reason_code]++;
		break;
	default:
		dinfo->remote_deauth[reason_code]++;
		break;
	}

	spin_unlock_bh(&deauth.lock);

	schedule_work(&deauth_worker);
}

static void trace_rx_icmp6_wake(struct wakeup_trace *tracer, void *data)
{
	void *iphdr_addr;
	struct ipv6hdr *ipv6_hdr;
	struct icmp6hdr *icmp6_hdr;

	iphdr_addr = data + sizeof(struct ethhdr);
	ipv6_hdr = iphdr_addr;
	if (ipv6_hdr->nexthdr == IPPROTO_ICMPV6) {
		tracer->pkt_type_dtl.icmp6_pkt_cnt++;

		icmp6_hdr = (struct icmp6hdr *)(iphdr_addr + sizeof(*ipv6_hdr));
		switch (icmp6_hdr->icmp6_type) {
		case NDISC_ROUTER_ADVERTISEMENT:
			tracer->pkt_type_dtl.icmp6_ra_cnt++;
			break;

		case NDISC_NEIGHBOUR_SOLICITATION:
			tracer->pkt_type_dtl.icmp6_ns_cnt++;
			break;

		case NDISC_NEIGHBOUR_ADVERTISEMENT:
			tracer->pkt_type_dtl.icmp6_na_cnt++;
			break;

		default:
			break;
		}
	}
}

static void trace_rx_data_wake(struct wakeup_trace *tracer, void *data)
{
	void *iphdr_addr = data;
	struct ethhdr *ether_hdr = data;
	struct iphdr *ipv4_hdr;

	if (is_broadcast_ether_addr(ether_hdr->h_dest)) {
		tracer->rx_data_dtl.rx_brdcst_cnt++;
	} else if (is_multicast_ether_addr(ether_hdr->h_dest)) {
		switch (ntohs(ether_hdr->h_proto)) {
		case ETH_P_IP:
			tracer->rx_data_dtl.rx_mc_dtl.ipv4_mc_cnt++;
			break;
		case ETH_P_IPV6:
			tracer->rx_data_dtl.rx_mc_dtl.ipv6_mc_cnt++;
			trace_rx_icmp6_wake(tracer, ether_hdr);
			break;
		default:
			tracer->rx_data_dtl.rx_mc_dtl.other_mc_cnt++;
			break;
		}

	} else { /*unicast*/
		tracer->rx_data_dtl.rx_unicast_cnt++;
		iphdr_addr += sizeof(*ether_hdr);
		switch (ntohs(ether_hdr->h_proto)) {
		case ETH_P_IP:
			ipv4_hdr = iphdr_addr;
			if (ipv4_hdr->protocol == IPPROTO_ICMP)
				tracer->pkt_type_dtl.icmp_pkt_cnt++;
			break;

		case ETH_P_IPV6:
			trace_rx_icmp6_wake(tracer, ether_hdr);
			break;
		default:
			wl_info("recv proto = 0x%x\n",
				ntohs(ether_hdr->h_proto));
			break;
		}
	}
}

void trace_rx_wakeup(struct wakeup_trace *tracer, void *data, void *rdata)
{
	int type;
	struct rx_msdu_desc *msdu;

	if (!SPRD_HEAD_GET_RESUME_BIT(data))
		return;

	tracer->resume_flag = 0;

	type = SPRDWL_HEAD_GET_TYPE(data);
	switch (type) {
	/* commands or events between command WIFI_CMD_POWER_SAVE
	 * and its respone just consider as one wake up source
	 */
	case SPRDWL_TYPE_CMD:
	case SPRDWL_TYPE_EVENT:
		tracer->total_cmd_event_wake++;
		wl_info("wake up by cmd/event[%d] (%d times)\n",
			type, tracer->total_cmd_event_wake);
		break;

	case SPRDWL_TYPE_DATA_SPECIAL:
		tracer->total_rx_data_wake++;

		msdu = (struct rx_msdu_desc *)rdata;
		trace_rx_data_wake(tracer, rdata + msdu->msdu_offset);
		wl_info("wake up by data (%d times)\n",
			tracer->total_rx_data_wake);
		break;

	case SPRDWL_TYPE_PKT_LOG:
		tracer->total_local_wake++;
		wl_info("wake up by pkt log (%d times)\n",
			tracer->total_local_wake);
		break;

	default:
		wl_info("wake up source untrace type = 0x%x\n", type);
		break;
	}
}

void trace_info_init(void)
{
	spin_lock_init(&deauth.lock);
}

void trace_info_deinit(void)
{
	cancel_work_sync(&deauth_worker);
}