[qca-nss-drv] NSS PPE stats
Changes to enable various PPE stats through debugfs.
Currently there are 3 new files implemented under -
/sys/kernel/debug/qca-nss-drv/ppe/ for connection,
l3-debug and packet code related information.
Change-Id: I13e8e030be90402c7b4bd5551144a4ef788e0b64
Signed-off-by: Amit Gupta <amitgupt@codeaurora.org>
diff --git a/nss_ppe.c b/nss_ppe.c
new file mode 100644
index 0000000..5c694cf
--- /dev/null
+++ b/nss_ppe.c
@@ -0,0 +1,262 @@
+/*
+ **************************************************************************
+ * Copyright (c) 2016, 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.
+ **************************************************************************
+ */
+
+#include "nss_ppe.h"
+
+/*
+ * nss_ppe_verify_ifnum()
+ * Verify PPE interface number.
+ */
+static inline bool nss_ppe_verify_ifnum(int if_num)
+{
+ return nss_is_dynamic_interface(if_num) || (if_num == NSS_PPE_INTERFACE);
+}
+
+/*
+ * nss_ppe_stats_sync
+ * PPE connection sync stats from NSS
+ */
+static void nss_ppe_stats_sync(struct nss_ctx_instance *nss_ctx, struct nss_ppe_sync_stats_msg *stats_msg, uint16_t if_num)
+{
+ spin_lock_bh(&nss_ppe_stats_lock);
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_V4_L3_FLOWS] += stats_msg->nss_ppe_v4_l3_flows;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_V4_L2_FLOWS] += stats_msg->nss_ppe_v4_l2_flows;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_V4_CREATE_REQ] += stats_msg->nss_ppe_v4_create_req;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_V4_CREATE_FAIL] += stats_msg->nss_ppe_v4_create_fail;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_V4_DESTROY_REQ] += stats_msg->nss_ppe_v4_destroy_req;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_V4_DESTROY_FAIL] += stats_msg->nss_ppe_v4_destroy_fail;
+
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_V6_L3_FLOWS] += stats_msg->nss_ppe_v6_l3_flows;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_V6_L2_FLOWS] += stats_msg->nss_ppe_v6_l2_flows;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_V6_CREATE_REQ] += stats_msg->nss_ppe_v6_create_req;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_V6_CREATE_FAIL] += stats_msg->nss_ppe_v6_create_fail;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_V6_DESTROY_REQ] += stats_msg->nss_ppe_v6_destroy_req;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_V6_DESTROY_FAIL] += stats_msg->nss_ppe_v6_destroy_fail;
+
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_FAIL_NH_FULL] += stats_msg->nss_ppe_fail_nh_full;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_FAIL_FLOW_FULL] += stats_msg->nss_ppe_fail_flow_full;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_FAIL_HOST_FULL] += stats_msg->nss_ppe_fail_host_full;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_FAIL_PUBIP_FULL] += stats_msg->nss_ppe_fail_pubip_full;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_FAIL_PORT_SETUP] += stats_msg->nss_ppe_fail_port_setup;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_FAIL_RW_FIFO_FULL] += stats_msg->nss_ppe_fail_rw_fifo_full;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_FAIL_FLOW_COMMAND] += stats_msg->nss_ppe_fail_flow_command;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_FAIL_UNKNOWN_PROTO] += stats_msg->nss_ppe_fail_unknown_proto;
+ nss_ppe_debug_stats.conn_stats[NSS_STATS_PPE_FAIL_PPE_UNRESPONSIVE] += stats_msg->nss_ppe_fail_ppe_unresponsive;
+ spin_unlock_bh(&nss_ppe_stats_lock);
+}
+
+/*
+ * nss_ppe_stats_conn_get()
+ * Get ppe connection stats.
+ */
+void nss_ppe_stats_conn_get(uint32_t *stats)
+{
+ if (!stats) {
+ nss_warning("No memory to copy ppe connection stats");
+ return;
+ }
+
+ spin_lock_bh(&nss_ppe_stats_lock);
+
+ if (!nss_ppe_debug_stats.valid) {
+ spin_unlock_bh(&nss_ppe_stats_lock);
+ nss_warning("PPE base address not initialized!\n");
+ return;
+ }
+
+ /*
+ * Get flow stats
+ */
+ memcpy(stats, nss_ppe_debug_stats.conn_stats, (sizeof(uint32_t) * NSS_STATS_PPE_CONN_MAX));
+
+ spin_unlock_bh(&nss_ppe_stats_lock);
+}
+
+/*
+ * nss_ppe_stats_l3_get()
+ * Get ppe L3 debug stats.
+ */
+void nss_ppe_stats_l3_get(uint32_t *stats)
+{
+ if (!stats) {
+ nss_warning("No memory to copy ppe l3 dbg stats\n");
+ return;
+ }
+
+ spin_lock_bh(&nss_ppe_stats_lock);
+
+ if (!nss_ppe_debug_stats.valid) {
+ spin_unlock_bh(&nss_ppe_stats_lock);
+ nss_warning("PPE base address not initialized!\n");
+ return;
+ }
+
+ nss_ppe_reg_write(PPE_L3_DBG_WR_OFFSET, PPE_L3_DBG0_OFFSET);
+ nss_ppe_reg_read(PPE_L3_DBG_RD_OFFSET, &stats[NSS_STATS_PPE_L3_DBG_0]);
+
+ nss_ppe_reg_write(PPE_L3_DBG_WR_OFFSET, PPE_L3_DBG1_OFFSET);
+ nss_ppe_reg_read(PPE_L3_DBG_RD_OFFSET, &stats[NSS_STATS_PPE_L3_DBG_1]);
+
+ nss_ppe_reg_write(PPE_L3_DBG_WR_OFFSET, PPE_L3_DBG2_OFFSET);
+ nss_ppe_reg_read(PPE_L3_DBG_RD_OFFSET, &stats[NSS_STATS_PPE_L3_DBG_2]);
+
+ nss_ppe_reg_write(PPE_L3_DBG_WR_OFFSET, PPE_L3_DBG3_OFFSET);
+ nss_ppe_reg_read(PPE_L3_DBG_RD_OFFSET, &stats[NSS_STATS_PPE_L3_DBG_3]);
+
+ nss_ppe_reg_write(PPE_L3_DBG_WR_OFFSET, PPE_L3_DBG4_OFFSET);
+ nss_ppe_reg_read(PPE_L3_DBG_RD_OFFSET, &stats[NSS_STATS_PPE_L3_DBG_4]);
+
+ nss_ppe_reg_write(PPE_L3_DBG_WR_OFFSET, PPE_L3_DBG_PORT_OFFSET);
+ nss_ppe_reg_read(PPE_L3_DBG_RD_OFFSET, &stats[NSS_STATS_PPE_L3_DBG_PORT]);
+
+ spin_unlock_bh(&nss_ppe_stats_lock);
+}
+
+/*
+ * nss_ppe_stats_code_get()
+ * Get ppe CPU and DROP code for last packet processed.
+ */
+void nss_ppe_stats_code_get(uint32_t *stats)
+{
+ uint32_t drop_0, drop_1, cpu_code;
+
+ nss_trace("%s(%d) Start\n", __func__, __LINE__);
+ if (!stats) {
+ nss_warning("No memory to copy ppe code\n");
+ return;
+ }
+
+ if (!nss_ppe_debug_stats.valid) {
+ nss_warning("PPE base address not initialized!\n");
+ return;
+ }
+
+ spin_lock_bh(&nss_ppe_stats_lock);
+ nss_ppe_reg_write(PPE_PKT_CODE_WR_OFFSET, PPE_PKT_CODE_DROP0_OFFSET);
+ nss_ppe_reg_read(PPE_PKT_CODE_RD_OFFSET, &drop_0);
+
+ nss_ppe_reg_write(PPE_PKT_CODE_WR_OFFSET, PPE_PKT_CODE_DROP1_OFFSET);
+ nss_ppe_reg_read(PPE_PKT_CODE_RD_OFFSET, &drop_1);
+
+ stats[NSS_STATS_PPE_CODE_DROP] = PPE_PKT_CODE_DROP_GET(drop_0, drop_1);
+
+ nss_ppe_reg_write(PPE_PKT_CODE_WR_OFFSET, PPE_PKT_CODE_CPU_OFFSET);
+ nss_ppe_reg_read(PPE_PKT_CODE_RD_OFFSET, &cpu_code);
+
+ stats[NSS_STATS_PPE_CODE_CPU] = PPE_PKT_CODE_CPU_GET(cpu_code);
+
+ spin_unlock_bh(&nss_ppe_stats_lock);
+}
+
+/*
+ * nss_ppe_handler()
+ * Handle NSS -> HLOS messages for ppe tunnel
+ */
+static void nss_ppe_handler(struct nss_ctx_instance *nss_ctx, struct nss_cmn_msg *ncm, __attribute__((unused))void *app_data)
+{
+ struct nss_ppe_msg *msg = (struct nss_ppe_msg *)ncm;
+
+ nss_trace("nss_ctx: %p ppe msg: %p", nss_ctx, msg);
+ BUG_ON(!nss_ppe_verify_ifnum(ncm->interface));
+
+ /*
+ * Is this a valid request/response packet?
+ */
+ if (ncm->type >= NSS_PPE_MSG_MAX) {
+ nss_warning("%p: received invalid message %d for PPE interface", nss_ctx, ncm->type);
+ return;
+ }
+
+ if (nss_cmn_get_msg_len(ncm) > sizeof(struct nss_ppe_msg)) {
+ nss_warning("%p: Length of message is greater than required: %d", nss_ctx, nss_cmn_get_msg_len(ncm));
+ return;
+ }
+
+ switch (msg->cm.type) {
+ case NSS_PPE_MSG_SYNC_STATS:
+ /*
+ * session debug stats embeded in session stats msg
+ */
+ nss_ppe_stats_sync(nss_ctx, &msg->msg.stats, ncm->interface);
+ break;
+ }
+}
+
+/*
+ * nss_ppe_register_handler()
+ * debugfs stats msg handler received on static ppe interface
+ *
+ * TODO: Export API so that others can also read PPE stats.
+ */
+void nss_ppe_register_handler(void)
+{
+ nss_core_register_handler(NSS_PPE_INTERFACE, nss_ppe_handler, NULL);
+}
+
+/*
+ * nss_ppe_free()
+ * Uninitialize PPE base
+ */
+void nss_ppe_free(void)
+{
+ /*
+ * Check if PPE base is already uninitialized.
+ */
+ if (!ppe_pvt.ppe_base) {
+ return;
+ }
+
+ /*
+ * Unmap PPE base address
+ */
+ iounmap(ppe_pvt.ppe_base);
+ ppe_pvt.ppe_base = NULL;
+
+ spin_lock_bh(&nss_ppe_stats_lock);
+ nss_ppe_debug_stats.valid = false;
+ nss_ppe_debug_stats.if_num = 0;
+ nss_ppe_debug_stats.if_index = 0;
+ spin_unlock_bh(&nss_ppe_stats_lock);
+}
+
+/*
+ * nss_ppe_init()
+ * Initialize PPE base
+ */
+void nss_ppe_init(void)
+{
+ /*
+ * Check if PPE base is already initialized.
+ */
+ if (ppe_pvt.ppe_base) {
+ return;
+ }
+
+ /*
+ * Get the PPE base address
+ */
+ ppe_pvt.ppe_base = ioremap_nocache(PPE_BASE_ADDR, PPE_REG_SIZE);
+ if (!ppe_pvt.ppe_base) {
+ nss_warning("DRV can't get PPE base address\n");
+ return;
+ }
+
+ spin_lock_bh(&nss_ppe_stats_lock);
+ nss_ppe_debug_stats.valid = true;
+ nss_ppe_debug_stats.if_num = 0;
+ nss_ppe_debug_stats.if_index = 0;
+ spin_unlock_bh(&nss_ppe_stats_lock);
+}