qca-nss-clients/netlink/nss_nlc2c_tx.c

/*
 **************************************************************************
 * Copyright (c) 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.
 **************************************************************************
 */

/*
 * nss_nlc2c_tx.c
 *	NSS Netlink c2c_tx Handler
 */
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/version.h>
#include <linux/netlink.h>
#include <linux/version.h>
#include <linux/vmalloc.h>
#include <linux/notifier.h>

#include <net/genetlink.h>
#include <net/sock.h>

#include <nss_api_if.h>
#include <nss_cmn.h>
#include <nss_nl_if.h>
#include "nss_nl.h"
#include "nss_nlcmn_if.h"
#include "nss_nlc2c_tx_if.h"
#include "nss_c2c_tx.h"

/*
 * prototypes
 */
static int nss_nlc2c_tx_ops_get_stats(struct sk_buff *skb, struct genl_info *info);
static int nss_nlc2c_tx_process_notify(struct notifier_block *nb,  unsigned long val, void *data);

/*
 * multicast group for sending message status & events
 */
static const struct genl_multicast_group nss_nlc2c_tx_mcgrp[] = {
	{.name = NSS_NLC2C_TX_MCAST_GRP},
};

/*
 * operation table called by the generic netlink layer based on the command
 */
static struct genl_ops nss_nlc2c_tx_ops[] = {
	{.cmd = NSS_STATS_EVENT_NOTIFY, .doit = nss_nlc2c_tx_ops_get_stats},
};

/*
 * c2c_tx family definition
 */
static struct genl_family nss_nlc2c_tx_family = {
#if (LINUX_VERSION_CODE <= KERNEL_VERSION(4, 9, 0))
	.id = GENL_ID_GENERATE,						/* Auto generate ID */
#endif
	.name = NSS_NLC2C_TX_FAMILY,					/* family name string */
	.hdrsize = sizeof(struct nss_c2c_tx_stats_notification),	/* NSS NETLINK c2c_tx stats */
	.version = NSS_NL_VER,						/* Set it to NSS_NLC2C_TX version */
	.maxattr = NSS_STATS_EVENT_MAX,					/* maximum commands supported */
	.netnsok = true,
	.pre_doit = NULL,
	.post_doit = NULL,
	.ops = nss_nlc2c_tx_ops,
	.n_ops = ARRAY_SIZE(nss_nlc2c_tx_ops),
	.mcgrps = nss_nlc2c_tx_mcgrp,
	.n_mcgrps = ARRAY_SIZE(nss_nlc2c_tx_mcgrp)
};

/*
 * stats call back handler for c2c_tx from NSS
 */
static struct notifier_block nss_c2c_tx_stats_notifier_nb = {
	.notifier_call = nss_nlc2c_tx_process_notify,
};

/*
 * nss_nlc2c_tx_ops_get_stats()
 *	get stats handler
 */
static int nss_nlc2c_tx_ops_get_stats(struct sk_buff *skb, struct genl_info *info)
{
	return 0;
}

/*
 * nss_nlc2c_tx_process_notify()
 *	process notification messages from NSS
 */
static int nss_nlc2c_tx_process_notify(struct notifier_block *nb, unsigned long val, void *data)
{
	struct sk_buff *skb;
	struct nss_c2c_tx_stats_notification *nss_stats, *nl_stats;

	skb = nss_nl_new_msg(&nss_nlc2c_tx_family, NSS_NLCMN_SUBSYS_C2C_TX);
	if (!skb) {
		nss_nl_error("unable to allocate NSS_NLC2C_TX event\n");
		return NOTIFY_DONE;
	}

	nl_stats = nss_nl_get_data(skb);
	nss_stats = (struct nss_c2c_tx_stats_notification *)data;
	memcpy(nl_stats, nss_stats, sizeof(struct nss_c2c_tx_stats_notification));
	nss_nl_mcast_event(&nss_nlc2c_tx_family, skb);

	return NOTIFY_DONE;
}

/*
 * nss_nlc2c_tx_init()
 *	handler init
 */
bool nss_nlc2c_tx_init(void)
{
	int error,ret;

	nss_nl_info_always("Init NSS netlink c2c_tx handler\n");

	/*
	 * register NETLINK ops with the family
	 */
	error = genl_register_family(&nss_nlc2c_tx_family);
	if (error) {
		nss_nl_info_always("Error: unable to register c2c_tx family\n");
		return false;
	}

	/*
	 * register device call back handler for c2c_tx from NSS
	 */
	ret = nss_c2c_tx_stats_register_notifier(&nss_c2c_tx_stats_notifier_nb);
	if (ret) {
		nss_nl_info_always("Error: retreiving the NSS Context \n");
		genl_unregister_family(&nss_nlc2c_tx_family);
		return false;
	}

	return true;
}

/*
 * nss_nlc2c_tx_exit()
 *	handler exit
 */
bool nss_nlc2c_tx_exit(void)
{
	int error;

	nss_nl_info_always("Exit NSS netlink c2c_tx handler\n");

	/*
	 * Unregister the device callback handler for c2c_tx
	 */
	nss_c2c_tx_stats_unregister_notifier(&nss_c2c_tx_stats_notifier_nb);

	/*
	 * unregister the ops family
	 */
	error = genl_unregister_family(&nss_nlc2c_tx_family);
	if (error) {
		nss_nl_info_always("unable to unregister c2c_tx NETLINK family\n");
		return false;
	}

	return true;
}