qca-nss-clients/netlink/nss_nldynamic_interface.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_nldynamic_interface.c
 *      NSS Netlink dynamic interface 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_nldynamic_interface_if.h"
#include "nss_dynamic_interface.h"

/*
 * prototypes
 */
static int nss_nldynamic_interface_ops_get_stats(struct sk_buff *skb, struct genl_info *info);
static int nss_nldynamic_interface_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_nldynamic_interface_mcgrp[] = {
	{.name = NSS_NLDYNAMIC_INTERFACE_MCAST_GRP},
};

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

/*
 * dynamic interface family definition
 */
static struct genl_family nss_nldynamic_interface_family = {
#if (LINUX_VERSION_CODE <= KERNEL_VERSION(4, 9, 0))
	.id = GENL_ID_GENERATE,					/* Auto generate ID */
#endif
	.name = NSS_NLDYNAMIC_INTERFACE_FAMILY,			/* family name string */
	.hdrsize = sizeof(struct nss_dynamic_interface_notification),	/* NSS NETLINK dynamic interface information */
	.version = NSS_NL_VER,					/* Set it to NSS_NLDYNAMIC_INTERFACE version */
	.maxattr = NSS_STATS_EVENT_MAX,				/* maximum commands supported */
	.netnsok = true,
	.pre_doit = NULL,
	.post_doit = NULL,
	.ops = nss_nldynamic_interface_ops,
	.n_ops = ARRAY_SIZE(nss_nldynamic_interface_ops),
	.mcgrps = nss_nldynamic_interface_mcgrp,
	.n_mcgrps = ARRAY_SIZE(nss_nldynamic_interface_mcgrp)
};

/*
 * destroy interface call back handler for dynamic interface from NSS
 */
static struct notifier_block nss_dynamic_interface_stats_notifier_nb = {
	.notifier_call = nss_nldynamic_interface_process_notify,
};

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

/*
 * nss_nldynamic_interface_process_notify()
 *	process notification messages from NSS
 */
static int nss_nldynamic_interface_process_notify(struct notifier_block *nb, unsigned long val, void *data)
{
	struct sk_buff *skb;
	struct nss_dynamic_interface_notification *nss_notification, *nl_notification;

	nss_notification = (struct nss_dynamic_interface_notification *)data;
	skb = nss_nl_new_msg(&nss_nldynamic_interface_family, NSS_NLCMN_SUBSYS_DYNAMIC_INTERFACE);
	if (!skb) {
		nss_nl_error("unable to allocate NSS_NLDYNAMIC_INTERFACE event\n");
		return NOTIFY_DONE;
	}

	nl_notification = nss_nl_get_data(skb);
	memcpy(nl_notification, nss_notification, sizeof(struct nss_dynamic_interface_notification));
	nss_nl_mcast_event(&nss_nldynamic_interface_family, skb);

	return NOTIFY_DONE;
}

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

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

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

	/*
	 * register device call back handler for dynamic interface from NSS
	 */
	ret = nss_dynamic_interface_stats_register_notifier(&nss_dynamic_interface_stats_notifier_nb);
	if (ret) {
		nss_nl_info_always("Error: retreiving the NSS Context \n");
		genl_unregister_family(&nss_nldynamic_interface_family);
		return false;
	}

	return true;
}

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

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

	/*
	 * Unregister the device callback handler for dynamic interface
	 */
	nss_dynamic_interface_stats_unregister_notifier(&nss_dynamic_interface_stats_notifier_nb);

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

	return true;
}