18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci#define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
38c2ecf20Sopenharmony_ci
48c2ecf20Sopenharmony_ci#ifdef CONFIG_PROC_FS
58c2ecf20Sopenharmony_ci#include <linux/errno.h>
68c2ecf20Sopenharmony_ci#include <linux/kernel.h>
78c2ecf20Sopenharmony_ci#include <linux/string.h>
88c2ecf20Sopenharmony_ci#include <linux/mm.h>
98c2ecf20Sopenharmony_ci#include <linux/module.h>
108c2ecf20Sopenharmony_ci#include <linux/proc_fs.h>
118c2ecf20Sopenharmony_ci#include <linux/ktime.h>
128c2ecf20Sopenharmony_ci#include <linux/seq_file.h>
138c2ecf20Sopenharmony_ci#include <linux/uaccess.h>
148c2ecf20Sopenharmony_ci#include <linux/atmmpc.h>
158c2ecf20Sopenharmony_ci#include <linux/atm.h>
168c2ecf20Sopenharmony_ci#include <linux/gfp.h>
178c2ecf20Sopenharmony_ci#include "mpc.h"
188c2ecf20Sopenharmony_ci#include "mpoa_caches.h"
198c2ecf20Sopenharmony_ci
208c2ecf20Sopenharmony_ci/*
218c2ecf20Sopenharmony_ci * mpoa_proc.c: Implementation MPOA client's proc
228c2ecf20Sopenharmony_ci * file system statistics
238c2ecf20Sopenharmony_ci */
248c2ecf20Sopenharmony_ci
258c2ecf20Sopenharmony_ci#if 1
268c2ecf20Sopenharmony_ci#define dprintk(format, args...)					\
278c2ecf20Sopenharmony_ci	printk(KERN_DEBUG "mpoa:%s: " format, __FILE__, ##args)  /* debug */
288c2ecf20Sopenharmony_ci#else
298c2ecf20Sopenharmony_ci#define dprintk(format, args...)					\
308c2ecf20Sopenharmony_ci	do { if (0)							\
318c2ecf20Sopenharmony_ci		printk(KERN_DEBUG "mpoa:%s: " format, __FILE__, ##args);\
328c2ecf20Sopenharmony_ci	} while (0)
338c2ecf20Sopenharmony_ci#endif
348c2ecf20Sopenharmony_ci
358c2ecf20Sopenharmony_ci#if 0
368c2ecf20Sopenharmony_ci#define ddprintk(format, args...)					\
378c2ecf20Sopenharmony_ci	printk(KERN_DEBUG "mpoa:%s: " format, __FILE__, ##args)  /* debug */
388c2ecf20Sopenharmony_ci#else
398c2ecf20Sopenharmony_ci#define ddprintk(format, args...)					\
408c2ecf20Sopenharmony_ci	do { if (0)							\
418c2ecf20Sopenharmony_ci		printk(KERN_DEBUG "mpoa:%s: " format, __FILE__, ##args);\
428c2ecf20Sopenharmony_ci	} while (0)
438c2ecf20Sopenharmony_ci#endif
448c2ecf20Sopenharmony_ci
458c2ecf20Sopenharmony_ci#define STAT_FILE_NAME "mpc"     /* Our statistic file's name */
468c2ecf20Sopenharmony_ci
478c2ecf20Sopenharmony_ciextern struct mpoa_client *mpcs;
488c2ecf20Sopenharmony_ciextern struct proc_dir_entry *atm_proc_root;  /* from proc.c. */
498c2ecf20Sopenharmony_ci
508c2ecf20Sopenharmony_cistatic int proc_mpc_open(struct inode *inode, struct file *file);
518c2ecf20Sopenharmony_cistatic ssize_t proc_mpc_write(struct file *file, const char __user *buff,
528c2ecf20Sopenharmony_ci			      size_t nbytes, loff_t *ppos);
538c2ecf20Sopenharmony_ci
548c2ecf20Sopenharmony_cistatic int parse_qos(const char *buff);
558c2ecf20Sopenharmony_ci
568c2ecf20Sopenharmony_cistatic const struct proc_ops mpc_proc_ops = {
578c2ecf20Sopenharmony_ci	.proc_open	= proc_mpc_open,
588c2ecf20Sopenharmony_ci	.proc_read	= seq_read,
598c2ecf20Sopenharmony_ci	.proc_lseek	= seq_lseek,
608c2ecf20Sopenharmony_ci	.proc_write	= proc_mpc_write,
618c2ecf20Sopenharmony_ci	.proc_release	= seq_release,
628c2ecf20Sopenharmony_ci};
638c2ecf20Sopenharmony_ci
648c2ecf20Sopenharmony_ci/*
658c2ecf20Sopenharmony_ci * Returns the state of an ingress cache entry as a string
668c2ecf20Sopenharmony_ci */
678c2ecf20Sopenharmony_cistatic const char *ingress_state_string(int state)
688c2ecf20Sopenharmony_ci{
698c2ecf20Sopenharmony_ci	switch (state) {
708c2ecf20Sopenharmony_ci	case INGRESS_RESOLVING:
718c2ecf20Sopenharmony_ci		return "resolving  ";
728c2ecf20Sopenharmony_ci	case INGRESS_RESOLVED:
738c2ecf20Sopenharmony_ci		return "resolved   ";
748c2ecf20Sopenharmony_ci	case INGRESS_INVALID:
758c2ecf20Sopenharmony_ci		return "invalid    ";
768c2ecf20Sopenharmony_ci	case INGRESS_REFRESHING:
778c2ecf20Sopenharmony_ci		return "refreshing ";
788c2ecf20Sopenharmony_ci	}
798c2ecf20Sopenharmony_ci
808c2ecf20Sopenharmony_ci	return "";
818c2ecf20Sopenharmony_ci}
828c2ecf20Sopenharmony_ci
838c2ecf20Sopenharmony_ci/*
848c2ecf20Sopenharmony_ci * Returns the state of an egress cache entry as a string
858c2ecf20Sopenharmony_ci */
868c2ecf20Sopenharmony_cistatic const char *egress_state_string(int state)
878c2ecf20Sopenharmony_ci{
888c2ecf20Sopenharmony_ci	switch (state) {
898c2ecf20Sopenharmony_ci	case EGRESS_RESOLVED:
908c2ecf20Sopenharmony_ci		return "resolved   ";
918c2ecf20Sopenharmony_ci	case EGRESS_PURGE:
928c2ecf20Sopenharmony_ci		return "purge      ";
938c2ecf20Sopenharmony_ci	case EGRESS_INVALID:
948c2ecf20Sopenharmony_ci		return "invalid    ";
958c2ecf20Sopenharmony_ci	}
968c2ecf20Sopenharmony_ci
978c2ecf20Sopenharmony_ci	return "";
988c2ecf20Sopenharmony_ci}
998c2ecf20Sopenharmony_ci
1008c2ecf20Sopenharmony_ci/*
1018c2ecf20Sopenharmony_ci * FIXME: mpcs (and per-mpc lists) have no locking whatsoever.
1028c2ecf20Sopenharmony_ci */
1038c2ecf20Sopenharmony_ci
1048c2ecf20Sopenharmony_cistatic void *mpc_start(struct seq_file *m, loff_t *pos)
1058c2ecf20Sopenharmony_ci{
1068c2ecf20Sopenharmony_ci	loff_t l = *pos;
1078c2ecf20Sopenharmony_ci	struct mpoa_client *mpc;
1088c2ecf20Sopenharmony_ci
1098c2ecf20Sopenharmony_ci	if (!l--)
1108c2ecf20Sopenharmony_ci		return SEQ_START_TOKEN;
1118c2ecf20Sopenharmony_ci	for (mpc = mpcs; mpc; mpc = mpc->next)
1128c2ecf20Sopenharmony_ci		if (!l--)
1138c2ecf20Sopenharmony_ci			return mpc;
1148c2ecf20Sopenharmony_ci	return NULL;
1158c2ecf20Sopenharmony_ci}
1168c2ecf20Sopenharmony_ci
1178c2ecf20Sopenharmony_cistatic void *mpc_next(struct seq_file *m, void *v, loff_t *pos)
1188c2ecf20Sopenharmony_ci{
1198c2ecf20Sopenharmony_ci	struct mpoa_client *p = v;
1208c2ecf20Sopenharmony_ci	(*pos)++;
1218c2ecf20Sopenharmony_ci	return v == SEQ_START_TOKEN ? mpcs : p->next;
1228c2ecf20Sopenharmony_ci}
1238c2ecf20Sopenharmony_ci
1248c2ecf20Sopenharmony_cistatic void mpc_stop(struct seq_file *m, void *v)
1258c2ecf20Sopenharmony_ci{
1268c2ecf20Sopenharmony_ci}
1278c2ecf20Sopenharmony_ci
1288c2ecf20Sopenharmony_ci/*
1298c2ecf20Sopenharmony_ci * READING function - called when the /proc/atm/mpoa file is read from.
1308c2ecf20Sopenharmony_ci */
1318c2ecf20Sopenharmony_cistatic int mpc_show(struct seq_file *m, void *v)
1328c2ecf20Sopenharmony_ci{
1338c2ecf20Sopenharmony_ci	struct mpoa_client *mpc = v;
1348c2ecf20Sopenharmony_ci	int i;
1358c2ecf20Sopenharmony_ci	in_cache_entry *in_entry;
1368c2ecf20Sopenharmony_ci	eg_cache_entry *eg_entry;
1378c2ecf20Sopenharmony_ci	time64_t now;
1388c2ecf20Sopenharmony_ci	unsigned char ip_string[16];
1398c2ecf20Sopenharmony_ci
1408c2ecf20Sopenharmony_ci	if (v == SEQ_START_TOKEN) {
1418c2ecf20Sopenharmony_ci		atm_mpoa_disp_qos(m);
1428c2ecf20Sopenharmony_ci		return 0;
1438c2ecf20Sopenharmony_ci	}
1448c2ecf20Sopenharmony_ci
1458c2ecf20Sopenharmony_ci	seq_printf(m, "\nInterface %d:\n\n", mpc->dev_num);
1468c2ecf20Sopenharmony_ci	seq_printf(m, "Ingress Entries:\nIP address      State      Holding time  Packets fwded  VPI  VCI\n");
1478c2ecf20Sopenharmony_ci	now = ktime_get_seconds();
1488c2ecf20Sopenharmony_ci
1498c2ecf20Sopenharmony_ci	for (in_entry = mpc->in_cache; in_entry; in_entry = in_entry->next) {
1508c2ecf20Sopenharmony_ci		unsigned long seconds_delta = now - in_entry->time;
1518c2ecf20Sopenharmony_ci
1528c2ecf20Sopenharmony_ci		sprintf(ip_string, "%pI4", &in_entry->ctrl_info.in_dst_ip);
1538c2ecf20Sopenharmony_ci		seq_printf(m, "%-16s%s%-14lu%-12u",
1548c2ecf20Sopenharmony_ci			   ip_string,
1558c2ecf20Sopenharmony_ci			   ingress_state_string(in_entry->entry_state),
1568c2ecf20Sopenharmony_ci			   in_entry->ctrl_info.holding_time -
1578c2ecf20Sopenharmony_ci			   seconds_delta,
1588c2ecf20Sopenharmony_ci			   in_entry->packets_fwded);
1598c2ecf20Sopenharmony_ci		if (in_entry->shortcut)
1608c2ecf20Sopenharmony_ci			seq_printf(m, "   %-3d  %-3d",
1618c2ecf20Sopenharmony_ci				   in_entry->shortcut->vpi,
1628c2ecf20Sopenharmony_ci				   in_entry->shortcut->vci);
1638c2ecf20Sopenharmony_ci		seq_printf(m, "\n");
1648c2ecf20Sopenharmony_ci	}
1658c2ecf20Sopenharmony_ci
1668c2ecf20Sopenharmony_ci	seq_printf(m, "\n");
1678c2ecf20Sopenharmony_ci	seq_printf(m, "Egress Entries:\nIngress MPC ATM addr\nCache-id        State      Holding time  Packets recvd  Latest IP addr   VPI VCI\n");
1688c2ecf20Sopenharmony_ci	for (eg_entry = mpc->eg_cache; eg_entry; eg_entry = eg_entry->next) {
1698c2ecf20Sopenharmony_ci		unsigned char *p = eg_entry->ctrl_info.in_MPC_data_ATM_addr;
1708c2ecf20Sopenharmony_ci		unsigned long seconds_delta = now - eg_entry->time;
1718c2ecf20Sopenharmony_ci
1728c2ecf20Sopenharmony_ci		for (i = 0; i < ATM_ESA_LEN; i++)
1738c2ecf20Sopenharmony_ci			seq_printf(m, "%02x", p[i]);
1748c2ecf20Sopenharmony_ci		seq_printf(m, "\n%-16lu%s%-14lu%-15u",
1758c2ecf20Sopenharmony_ci			   (unsigned long)ntohl(eg_entry->ctrl_info.cache_id),
1768c2ecf20Sopenharmony_ci			   egress_state_string(eg_entry->entry_state),
1778c2ecf20Sopenharmony_ci			   (eg_entry->ctrl_info.holding_time - seconds_delta),
1788c2ecf20Sopenharmony_ci			   eg_entry->packets_rcvd);
1798c2ecf20Sopenharmony_ci
1808c2ecf20Sopenharmony_ci		/* latest IP address */
1818c2ecf20Sopenharmony_ci		sprintf(ip_string, "%pI4", &eg_entry->latest_ip_addr);
1828c2ecf20Sopenharmony_ci		seq_printf(m, "%-16s", ip_string);
1838c2ecf20Sopenharmony_ci
1848c2ecf20Sopenharmony_ci		if (eg_entry->shortcut)
1858c2ecf20Sopenharmony_ci			seq_printf(m, " %-3d %-3d",
1868c2ecf20Sopenharmony_ci				   eg_entry->shortcut->vpi,
1878c2ecf20Sopenharmony_ci				   eg_entry->shortcut->vci);
1888c2ecf20Sopenharmony_ci		seq_printf(m, "\n");
1898c2ecf20Sopenharmony_ci	}
1908c2ecf20Sopenharmony_ci	seq_printf(m, "\n");
1918c2ecf20Sopenharmony_ci	return 0;
1928c2ecf20Sopenharmony_ci}
1938c2ecf20Sopenharmony_ci
1948c2ecf20Sopenharmony_cistatic const struct seq_operations mpc_op = {
1958c2ecf20Sopenharmony_ci	.start =	mpc_start,
1968c2ecf20Sopenharmony_ci	.next =		mpc_next,
1978c2ecf20Sopenharmony_ci	.stop =		mpc_stop,
1988c2ecf20Sopenharmony_ci	.show =		mpc_show
1998c2ecf20Sopenharmony_ci};
2008c2ecf20Sopenharmony_ci
2018c2ecf20Sopenharmony_cistatic int proc_mpc_open(struct inode *inode, struct file *file)
2028c2ecf20Sopenharmony_ci{
2038c2ecf20Sopenharmony_ci	return seq_open(file, &mpc_op);
2048c2ecf20Sopenharmony_ci}
2058c2ecf20Sopenharmony_ci
2068c2ecf20Sopenharmony_cistatic ssize_t proc_mpc_write(struct file *file, const char __user *buff,
2078c2ecf20Sopenharmony_ci			      size_t nbytes, loff_t *ppos)
2088c2ecf20Sopenharmony_ci{
2098c2ecf20Sopenharmony_ci	char *page, *p;
2108c2ecf20Sopenharmony_ci	unsigned int len;
2118c2ecf20Sopenharmony_ci
2128c2ecf20Sopenharmony_ci	if (nbytes == 0)
2138c2ecf20Sopenharmony_ci		return 0;
2148c2ecf20Sopenharmony_ci
2158c2ecf20Sopenharmony_ci	if (nbytes >= PAGE_SIZE)
2168c2ecf20Sopenharmony_ci		nbytes = PAGE_SIZE-1;
2178c2ecf20Sopenharmony_ci
2188c2ecf20Sopenharmony_ci	page = (char *)__get_free_page(GFP_KERNEL);
2198c2ecf20Sopenharmony_ci	if (!page)
2208c2ecf20Sopenharmony_ci		return -ENOMEM;
2218c2ecf20Sopenharmony_ci
2228c2ecf20Sopenharmony_ci	for (p = page, len = 0; len < nbytes; p++) {
2238c2ecf20Sopenharmony_ci		if (get_user(*p, buff++)) {
2248c2ecf20Sopenharmony_ci			free_page((unsigned long)page);
2258c2ecf20Sopenharmony_ci			return -EFAULT;
2268c2ecf20Sopenharmony_ci		}
2278c2ecf20Sopenharmony_ci		len += 1;
2288c2ecf20Sopenharmony_ci		if (*p == '\0' || *p == '\n')
2298c2ecf20Sopenharmony_ci			break;
2308c2ecf20Sopenharmony_ci	}
2318c2ecf20Sopenharmony_ci
2328c2ecf20Sopenharmony_ci	*p = '\0';
2338c2ecf20Sopenharmony_ci
2348c2ecf20Sopenharmony_ci	if (!parse_qos(page))
2358c2ecf20Sopenharmony_ci		printk("mpoa: proc_mpc_write: could not parse '%s'\n", page);
2368c2ecf20Sopenharmony_ci
2378c2ecf20Sopenharmony_ci	free_page((unsigned long)page);
2388c2ecf20Sopenharmony_ci
2398c2ecf20Sopenharmony_ci	return len;
2408c2ecf20Sopenharmony_ci}
2418c2ecf20Sopenharmony_ci
2428c2ecf20Sopenharmony_cistatic int parse_qos(const char *buff)
2438c2ecf20Sopenharmony_ci{
2448c2ecf20Sopenharmony_ci	/* possible lines look like this
2458c2ecf20Sopenharmony_ci	 * add 130.230.54.142 tx=max_pcr,max_sdu rx=max_pcr,max_sdu
2468c2ecf20Sopenharmony_ci	 */
2478c2ecf20Sopenharmony_ci	unsigned char ip[4];
2488c2ecf20Sopenharmony_ci	int tx_pcr, tx_sdu, rx_pcr, rx_sdu;
2498c2ecf20Sopenharmony_ci	__be32 ipaddr;
2508c2ecf20Sopenharmony_ci	struct atm_qos qos;
2518c2ecf20Sopenharmony_ci
2528c2ecf20Sopenharmony_ci	memset(&qos, 0, sizeof(struct atm_qos));
2538c2ecf20Sopenharmony_ci
2548c2ecf20Sopenharmony_ci	if (sscanf(buff, "del %hhu.%hhu.%hhu.%hhu",
2558c2ecf20Sopenharmony_ci			ip, ip+1, ip+2, ip+3) == 4) {
2568c2ecf20Sopenharmony_ci		ipaddr = *(__be32 *)ip;
2578c2ecf20Sopenharmony_ci		return atm_mpoa_delete_qos(atm_mpoa_search_qos(ipaddr));
2588c2ecf20Sopenharmony_ci	}
2598c2ecf20Sopenharmony_ci
2608c2ecf20Sopenharmony_ci	if (sscanf(buff, "add %hhu.%hhu.%hhu.%hhu tx=%d,%d rx=tx",
2618c2ecf20Sopenharmony_ci			ip, ip+1, ip+2, ip+3, &tx_pcr, &tx_sdu) == 6) {
2628c2ecf20Sopenharmony_ci		rx_pcr = tx_pcr;
2638c2ecf20Sopenharmony_ci		rx_sdu = tx_sdu;
2648c2ecf20Sopenharmony_ci	} else if (sscanf(buff, "add %hhu.%hhu.%hhu.%hhu tx=%d,%d rx=%d,%d",
2658c2ecf20Sopenharmony_ci		ip, ip+1, ip+2, ip+3, &tx_pcr, &tx_sdu, &rx_pcr, &rx_sdu) != 8)
2668c2ecf20Sopenharmony_ci		return 0;
2678c2ecf20Sopenharmony_ci
2688c2ecf20Sopenharmony_ci	ipaddr = *(__be32 *)ip;
2698c2ecf20Sopenharmony_ci	qos.txtp.traffic_class = ATM_CBR;
2708c2ecf20Sopenharmony_ci	qos.txtp.max_pcr = tx_pcr;
2718c2ecf20Sopenharmony_ci	qos.txtp.max_sdu = tx_sdu;
2728c2ecf20Sopenharmony_ci	qos.rxtp.traffic_class = ATM_CBR;
2738c2ecf20Sopenharmony_ci	qos.rxtp.max_pcr = rx_pcr;
2748c2ecf20Sopenharmony_ci	qos.rxtp.max_sdu = rx_sdu;
2758c2ecf20Sopenharmony_ci	qos.aal = ATM_AAL5;
2768c2ecf20Sopenharmony_ci	dprintk("parse_qos(): setting qos parameters to tx=%d,%d rx=%d,%d\n",
2778c2ecf20Sopenharmony_ci		qos.txtp.max_pcr, qos.txtp.max_sdu,
2788c2ecf20Sopenharmony_ci		qos.rxtp.max_pcr, qos.rxtp.max_sdu);
2798c2ecf20Sopenharmony_ci
2808c2ecf20Sopenharmony_ci	atm_mpoa_add_qos(ipaddr, &qos);
2818c2ecf20Sopenharmony_ci	return 1;
2828c2ecf20Sopenharmony_ci}
2838c2ecf20Sopenharmony_ci
2848c2ecf20Sopenharmony_ci/*
2858c2ecf20Sopenharmony_ci * INITIALIZATION function - called when module is initialized/loaded.
2868c2ecf20Sopenharmony_ci */
2878c2ecf20Sopenharmony_ciint mpc_proc_init(void)
2888c2ecf20Sopenharmony_ci{
2898c2ecf20Sopenharmony_ci	struct proc_dir_entry *p;
2908c2ecf20Sopenharmony_ci
2918c2ecf20Sopenharmony_ci	p = proc_create(STAT_FILE_NAME, 0, atm_proc_root, &mpc_proc_ops);
2928c2ecf20Sopenharmony_ci	if (!p) {
2938c2ecf20Sopenharmony_ci		pr_err("Unable to initialize /proc/atm/%s\n", STAT_FILE_NAME);
2948c2ecf20Sopenharmony_ci		return -ENOMEM;
2958c2ecf20Sopenharmony_ci	}
2968c2ecf20Sopenharmony_ci	return 0;
2978c2ecf20Sopenharmony_ci}
2988c2ecf20Sopenharmony_ci
2998c2ecf20Sopenharmony_ci/*
3008c2ecf20Sopenharmony_ci * DELETING function - called when module is removed.
3018c2ecf20Sopenharmony_ci */
3028c2ecf20Sopenharmony_civoid mpc_proc_clean(void)
3038c2ecf20Sopenharmony_ci{
3048c2ecf20Sopenharmony_ci	remove_proc_entry(STAT_FILE_NAME, atm_proc_root);
3058c2ecf20Sopenharmony_ci}
3068c2ecf20Sopenharmony_ci
3078c2ecf20Sopenharmony_ci#endif /* CONFIG_PROC_FS */
308