162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci#define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
362306a36Sopenharmony_ci
462306a36Sopenharmony_ci#ifdef CONFIG_PROC_FS
562306a36Sopenharmony_ci#include <linux/errno.h>
662306a36Sopenharmony_ci#include <linux/kernel.h>
762306a36Sopenharmony_ci#include <linux/string.h>
862306a36Sopenharmony_ci#include <linux/mm.h>
962306a36Sopenharmony_ci#include <linux/module.h>
1062306a36Sopenharmony_ci#include <linux/proc_fs.h>
1162306a36Sopenharmony_ci#include <linux/ktime.h>
1262306a36Sopenharmony_ci#include <linux/seq_file.h>
1362306a36Sopenharmony_ci#include <linux/uaccess.h>
1462306a36Sopenharmony_ci#include <linux/atmmpc.h>
1562306a36Sopenharmony_ci#include <linux/atm.h>
1662306a36Sopenharmony_ci#include <linux/gfp.h>
1762306a36Sopenharmony_ci#include "mpc.h"
1862306a36Sopenharmony_ci#include "mpoa_caches.h"
1962306a36Sopenharmony_ci
2062306a36Sopenharmony_ci/*
2162306a36Sopenharmony_ci * mpoa_proc.c: Implementation MPOA client's proc
2262306a36Sopenharmony_ci * file system statistics
2362306a36Sopenharmony_ci */
2462306a36Sopenharmony_ci
2562306a36Sopenharmony_ci#if 1
2662306a36Sopenharmony_ci#define dprintk(format, args...)					\
2762306a36Sopenharmony_ci	printk(KERN_DEBUG "mpoa:%s: " format, __FILE__, ##args)  /* debug */
2862306a36Sopenharmony_ci#else
2962306a36Sopenharmony_ci#define dprintk(format, args...)					\
3062306a36Sopenharmony_ci	do { if (0)							\
3162306a36Sopenharmony_ci		printk(KERN_DEBUG "mpoa:%s: " format, __FILE__, ##args);\
3262306a36Sopenharmony_ci	} while (0)
3362306a36Sopenharmony_ci#endif
3462306a36Sopenharmony_ci
3562306a36Sopenharmony_ci#if 0
3662306a36Sopenharmony_ci#define ddprintk(format, args...)					\
3762306a36Sopenharmony_ci	printk(KERN_DEBUG "mpoa:%s: " format, __FILE__, ##args)  /* debug */
3862306a36Sopenharmony_ci#else
3962306a36Sopenharmony_ci#define ddprintk(format, args...)					\
4062306a36Sopenharmony_ci	do { if (0)							\
4162306a36Sopenharmony_ci		printk(KERN_DEBUG "mpoa:%s: " format, __FILE__, ##args);\
4262306a36Sopenharmony_ci	} while (0)
4362306a36Sopenharmony_ci#endif
4462306a36Sopenharmony_ci
4562306a36Sopenharmony_ci#define STAT_FILE_NAME "mpc"     /* Our statistic file's name */
4662306a36Sopenharmony_ci
4762306a36Sopenharmony_ciextern struct mpoa_client *mpcs;
4862306a36Sopenharmony_ciextern struct proc_dir_entry *atm_proc_root;  /* from proc.c. */
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_cistatic int proc_mpc_open(struct inode *inode, struct file *file);
5162306a36Sopenharmony_cistatic ssize_t proc_mpc_write(struct file *file, const char __user *buff,
5262306a36Sopenharmony_ci			      size_t nbytes, loff_t *ppos);
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_cistatic int parse_qos(const char *buff);
5562306a36Sopenharmony_ci
5662306a36Sopenharmony_cistatic const struct proc_ops mpc_proc_ops = {
5762306a36Sopenharmony_ci	.proc_open	= proc_mpc_open,
5862306a36Sopenharmony_ci	.proc_read	= seq_read,
5962306a36Sopenharmony_ci	.proc_lseek	= seq_lseek,
6062306a36Sopenharmony_ci	.proc_write	= proc_mpc_write,
6162306a36Sopenharmony_ci	.proc_release	= seq_release,
6262306a36Sopenharmony_ci};
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_ci/*
6562306a36Sopenharmony_ci * Returns the state of an ingress cache entry as a string
6662306a36Sopenharmony_ci */
6762306a36Sopenharmony_cistatic const char *ingress_state_string(int state)
6862306a36Sopenharmony_ci{
6962306a36Sopenharmony_ci	switch (state) {
7062306a36Sopenharmony_ci	case INGRESS_RESOLVING:
7162306a36Sopenharmony_ci		return "resolving  ";
7262306a36Sopenharmony_ci	case INGRESS_RESOLVED:
7362306a36Sopenharmony_ci		return "resolved   ";
7462306a36Sopenharmony_ci	case INGRESS_INVALID:
7562306a36Sopenharmony_ci		return "invalid    ";
7662306a36Sopenharmony_ci	case INGRESS_REFRESHING:
7762306a36Sopenharmony_ci		return "refreshing ";
7862306a36Sopenharmony_ci	}
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_ci	return "";
8162306a36Sopenharmony_ci}
8262306a36Sopenharmony_ci
8362306a36Sopenharmony_ci/*
8462306a36Sopenharmony_ci * Returns the state of an egress cache entry as a string
8562306a36Sopenharmony_ci */
8662306a36Sopenharmony_cistatic const char *egress_state_string(int state)
8762306a36Sopenharmony_ci{
8862306a36Sopenharmony_ci	switch (state) {
8962306a36Sopenharmony_ci	case EGRESS_RESOLVED:
9062306a36Sopenharmony_ci		return "resolved   ";
9162306a36Sopenharmony_ci	case EGRESS_PURGE:
9262306a36Sopenharmony_ci		return "purge      ";
9362306a36Sopenharmony_ci	case EGRESS_INVALID:
9462306a36Sopenharmony_ci		return "invalid    ";
9562306a36Sopenharmony_ci	}
9662306a36Sopenharmony_ci
9762306a36Sopenharmony_ci	return "";
9862306a36Sopenharmony_ci}
9962306a36Sopenharmony_ci
10062306a36Sopenharmony_ci/*
10162306a36Sopenharmony_ci * FIXME: mpcs (and per-mpc lists) have no locking whatsoever.
10262306a36Sopenharmony_ci */
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_cistatic void *mpc_start(struct seq_file *m, loff_t *pos)
10562306a36Sopenharmony_ci{
10662306a36Sopenharmony_ci	loff_t l = *pos;
10762306a36Sopenharmony_ci	struct mpoa_client *mpc;
10862306a36Sopenharmony_ci
10962306a36Sopenharmony_ci	if (!l--)
11062306a36Sopenharmony_ci		return SEQ_START_TOKEN;
11162306a36Sopenharmony_ci	for (mpc = mpcs; mpc; mpc = mpc->next)
11262306a36Sopenharmony_ci		if (!l--)
11362306a36Sopenharmony_ci			return mpc;
11462306a36Sopenharmony_ci	return NULL;
11562306a36Sopenharmony_ci}
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_cistatic void *mpc_next(struct seq_file *m, void *v, loff_t *pos)
11862306a36Sopenharmony_ci{
11962306a36Sopenharmony_ci	struct mpoa_client *p = v;
12062306a36Sopenharmony_ci	(*pos)++;
12162306a36Sopenharmony_ci	return v == SEQ_START_TOKEN ? mpcs : p->next;
12262306a36Sopenharmony_ci}
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_cistatic void mpc_stop(struct seq_file *m, void *v)
12562306a36Sopenharmony_ci{
12662306a36Sopenharmony_ci}
12762306a36Sopenharmony_ci
12862306a36Sopenharmony_ci/*
12962306a36Sopenharmony_ci * READING function - called when the /proc/atm/mpoa file is read from.
13062306a36Sopenharmony_ci */
13162306a36Sopenharmony_cistatic int mpc_show(struct seq_file *m, void *v)
13262306a36Sopenharmony_ci{
13362306a36Sopenharmony_ci	struct mpoa_client *mpc = v;
13462306a36Sopenharmony_ci	int i;
13562306a36Sopenharmony_ci	in_cache_entry *in_entry;
13662306a36Sopenharmony_ci	eg_cache_entry *eg_entry;
13762306a36Sopenharmony_ci	time64_t now;
13862306a36Sopenharmony_ci	unsigned char ip_string[16];
13962306a36Sopenharmony_ci
14062306a36Sopenharmony_ci	if (v == SEQ_START_TOKEN) {
14162306a36Sopenharmony_ci		atm_mpoa_disp_qos(m);
14262306a36Sopenharmony_ci		return 0;
14362306a36Sopenharmony_ci	}
14462306a36Sopenharmony_ci
14562306a36Sopenharmony_ci	seq_printf(m, "\nInterface %d:\n\n", mpc->dev_num);
14662306a36Sopenharmony_ci	seq_printf(m, "Ingress Entries:\nIP address      State      Holding time  Packets fwded  VPI  VCI\n");
14762306a36Sopenharmony_ci	now = ktime_get_seconds();
14862306a36Sopenharmony_ci
14962306a36Sopenharmony_ci	for (in_entry = mpc->in_cache; in_entry; in_entry = in_entry->next) {
15062306a36Sopenharmony_ci		unsigned long seconds_delta = now - in_entry->time;
15162306a36Sopenharmony_ci
15262306a36Sopenharmony_ci		sprintf(ip_string, "%pI4", &in_entry->ctrl_info.in_dst_ip);
15362306a36Sopenharmony_ci		seq_printf(m, "%-16s%s%-14lu%-12u",
15462306a36Sopenharmony_ci			   ip_string,
15562306a36Sopenharmony_ci			   ingress_state_string(in_entry->entry_state),
15662306a36Sopenharmony_ci			   in_entry->ctrl_info.holding_time -
15762306a36Sopenharmony_ci			   seconds_delta,
15862306a36Sopenharmony_ci			   in_entry->packets_fwded);
15962306a36Sopenharmony_ci		if (in_entry->shortcut)
16062306a36Sopenharmony_ci			seq_printf(m, "   %-3d  %-3d",
16162306a36Sopenharmony_ci				   in_entry->shortcut->vpi,
16262306a36Sopenharmony_ci				   in_entry->shortcut->vci);
16362306a36Sopenharmony_ci		seq_printf(m, "\n");
16462306a36Sopenharmony_ci	}
16562306a36Sopenharmony_ci
16662306a36Sopenharmony_ci	seq_printf(m, "\n");
16762306a36Sopenharmony_ci	seq_printf(m, "Egress Entries:\nIngress MPC ATM addr\nCache-id        State      Holding time  Packets recvd  Latest IP addr   VPI VCI\n");
16862306a36Sopenharmony_ci	for (eg_entry = mpc->eg_cache; eg_entry; eg_entry = eg_entry->next) {
16962306a36Sopenharmony_ci		unsigned char *p = eg_entry->ctrl_info.in_MPC_data_ATM_addr;
17062306a36Sopenharmony_ci		unsigned long seconds_delta = now - eg_entry->time;
17162306a36Sopenharmony_ci
17262306a36Sopenharmony_ci		for (i = 0; i < ATM_ESA_LEN; i++)
17362306a36Sopenharmony_ci			seq_printf(m, "%02x", p[i]);
17462306a36Sopenharmony_ci		seq_printf(m, "\n%-16lu%s%-14lu%-15u",
17562306a36Sopenharmony_ci			   (unsigned long)ntohl(eg_entry->ctrl_info.cache_id),
17662306a36Sopenharmony_ci			   egress_state_string(eg_entry->entry_state),
17762306a36Sopenharmony_ci			   (eg_entry->ctrl_info.holding_time - seconds_delta),
17862306a36Sopenharmony_ci			   eg_entry->packets_rcvd);
17962306a36Sopenharmony_ci
18062306a36Sopenharmony_ci		/* latest IP address */
18162306a36Sopenharmony_ci		sprintf(ip_string, "%pI4", &eg_entry->latest_ip_addr);
18262306a36Sopenharmony_ci		seq_printf(m, "%-16s", ip_string);
18362306a36Sopenharmony_ci
18462306a36Sopenharmony_ci		if (eg_entry->shortcut)
18562306a36Sopenharmony_ci			seq_printf(m, " %-3d %-3d",
18662306a36Sopenharmony_ci				   eg_entry->shortcut->vpi,
18762306a36Sopenharmony_ci				   eg_entry->shortcut->vci);
18862306a36Sopenharmony_ci		seq_printf(m, "\n");
18962306a36Sopenharmony_ci	}
19062306a36Sopenharmony_ci	seq_printf(m, "\n");
19162306a36Sopenharmony_ci	return 0;
19262306a36Sopenharmony_ci}
19362306a36Sopenharmony_ci
19462306a36Sopenharmony_cistatic const struct seq_operations mpc_op = {
19562306a36Sopenharmony_ci	.start =	mpc_start,
19662306a36Sopenharmony_ci	.next =		mpc_next,
19762306a36Sopenharmony_ci	.stop =		mpc_stop,
19862306a36Sopenharmony_ci	.show =		mpc_show
19962306a36Sopenharmony_ci};
20062306a36Sopenharmony_ci
20162306a36Sopenharmony_cistatic int proc_mpc_open(struct inode *inode, struct file *file)
20262306a36Sopenharmony_ci{
20362306a36Sopenharmony_ci	return seq_open(file, &mpc_op);
20462306a36Sopenharmony_ci}
20562306a36Sopenharmony_ci
20662306a36Sopenharmony_cistatic ssize_t proc_mpc_write(struct file *file, const char __user *buff,
20762306a36Sopenharmony_ci			      size_t nbytes, loff_t *ppos)
20862306a36Sopenharmony_ci{
20962306a36Sopenharmony_ci	char *page, *p;
21062306a36Sopenharmony_ci	unsigned int len;
21162306a36Sopenharmony_ci
21262306a36Sopenharmony_ci	if (nbytes == 0)
21362306a36Sopenharmony_ci		return 0;
21462306a36Sopenharmony_ci
21562306a36Sopenharmony_ci	if (nbytes >= PAGE_SIZE)
21662306a36Sopenharmony_ci		nbytes = PAGE_SIZE-1;
21762306a36Sopenharmony_ci
21862306a36Sopenharmony_ci	page = (char *)__get_free_page(GFP_KERNEL);
21962306a36Sopenharmony_ci	if (!page)
22062306a36Sopenharmony_ci		return -ENOMEM;
22162306a36Sopenharmony_ci
22262306a36Sopenharmony_ci	for (p = page, len = 0; len < nbytes; p++) {
22362306a36Sopenharmony_ci		if (get_user(*p, buff++)) {
22462306a36Sopenharmony_ci			free_page((unsigned long)page);
22562306a36Sopenharmony_ci			return -EFAULT;
22662306a36Sopenharmony_ci		}
22762306a36Sopenharmony_ci		len += 1;
22862306a36Sopenharmony_ci		if (*p == '\0' || *p == '\n')
22962306a36Sopenharmony_ci			break;
23062306a36Sopenharmony_ci	}
23162306a36Sopenharmony_ci
23262306a36Sopenharmony_ci	*p = '\0';
23362306a36Sopenharmony_ci
23462306a36Sopenharmony_ci	if (!parse_qos(page))
23562306a36Sopenharmony_ci		printk("mpoa: proc_mpc_write: could not parse '%s'\n", page);
23662306a36Sopenharmony_ci
23762306a36Sopenharmony_ci	free_page((unsigned long)page);
23862306a36Sopenharmony_ci
23962306a36Sopenharmony_ci	return len;
24062306a36Sopenharmony_ci}
24162306a36Sopenharmony_ci
24262306a36Sopenharmony_cistatic int parse_qos(const char *buff)
24362306a36Sopenharmony_ci{
24462306a36Sopenharmony_ci	/* possible lines look like this
24562306a36Sopenharmony_ci	 * add 130.230.54.142 tx=max_pcr,max_sdu rx=max_pcr,max_sdu
24662306a36Sopenharmony_ci	 */
24762306a36Sopenharmony_ci	unsigned char ip[4];
24862306a36Sopenharmony_ci	int tx_pcr, tx_sdu, rx_pcr, rx_sdu;
24962306a36Sopenharmony_ci	__be32 ipaddr;
25062306a36Sopenharmony_ci	struct atm_qos qos;
25162306a36Sopenharmony_ci
25262306a36Sopenharmony_ci	memset(&qos, 0, sizeof(struct atm_qos));
25362306a36Sopenharmony_ci
25462306a36Sopenharmony_ci	if (sscanf(buff, "del %hhu.%hhu.%hhu.%hhu",
25562306a36Sopenharmony_ci			ip, ip+1, ip+2, ip+3) == 4) {
25662306a36Sopenharmony_ci		ipaddr = *(__be32 *)ip;
25762306a36Sopenharmony_ci		return atm_mpoa_delete_qos(atm_mpoa_search_qos(ipaddr));
25862306a36Sopenharmony_ci	}
25962306a36Sopenharmony_ci
26062306a36Sopenharmony_ci	if (sscanf(buff, "add %hhu.%hhu.%hhu.%hhu tx=%d,%d rx=tx",
26162306a36Sopenharmony_ci			ip, ip+1, ip+2, ip+3, &tx_pcr, &tx_sdu) == 6) {
26262306a36Sopenharmony_ci		rx_pcr = tx_pcr;
26362306a36Sopenharmony_ci		rx_sdu = tx_sdu;
26462306a36Sopenharmony_ci	} else if (sscanf(buff, "add %hhu.%hhu.%hhu.%hhu tx=%d,%d rx=%d,%d",
26562306a36Sopenharmony_ci		ip, ip+1, ip+2, ip+3, &tx_pcr, &tx_sdu, &rx_pcr, &rx_sdu) != 8)
26662306a36Sopenharmony_ci		return 0;
26762306a36Sopenharmony_ci
26862306a36Sopenharmony_ci	ipaddr = *(__be32 *)ip;
26962306a36Sopenharmony_ci	qos.txtp.traffic_class = ATM_CBR;
27062306a36Sopenharmony_ci	qos.txtp.max_pcr = tx_pcr;
27162306a36Sopenharmony_ci	qos.txtp.max_sdu = tx_sdu;
27262306a36Sopenharmony_ci	qos.rxtp.traffic_class = ATM_CBR;
27362306a36Sopenharmony_ci	qos.rxtp.max_pcr = rx_pcr;
27462306a36Sopenharmony_ci	qos.rxtp.max_sdu = rx_sdu;
27562306a36Sopenharmony_ci	qos.aal = ATM_AAL5;
27662306a36Sopenharmony_ci	dprintk("parse_qos(): setting qos parameters to tx=%d,%d rx=%d,%d\n",
27762306a36Sopenharmony_ci		qos.txtp.max_pcr, qos.txtp.max_sdu,
27862306a36Sopenharmony_ci		qos.rxtp.max_pcr, qos.rxtp.max_sdu);
27962306a36Sopenharmony_ci
28062306a36Sopenharmony_ci	atm_mpoa_add_qos(ipaddr, &qos);
28162306a36Sopenharmony_ci	return 1;
28262306a36Sopenharmony_ci}
28362306a36Sopenharmony_ci
28462306a36Sopenharmony_ci/*
28562306a36Sopenharmony_ci * INITIALIZATION function - called when module is initialized/loaded.
28662306a36Sopenharmony_ci */
28762306a36Sopenharmony_ciint mpc_proc_init(void)
28862306a36Sopenharmony_ci{
28962306a36Sopenharmony_ci	struct proc_dir_entry *p;
29062306a36Sopenharmony_ci
29162306a36Sopenharmony_ci	p = proc_create(STAT_FILE_NAME, 0, atm_proc_root, &mpc_proc_ops);
29262306a36Sopenharmony_ci	if (!p) {
29362306a36Sopenharmony_ci		pr_err("Unable to initialize /proc/atm/%s\n", STAT_FILE_NAME);
29462306a36Sopenharmony_ci		return -ENOMEM;
29562306a36Sopenharmony_ci	}
29662306a36Sopenharmony_ci	return 0;
29762306a36Sopenharmony_ci}
29862306a36Sopenharmony_ci
29962306a36Sopenharmony_ci/*
30062306a36Sopenharmony_ci * DELETING function - called when module is removed.
30162306a36Sopenharmony_ci */
30262306a36Sopenharmony_civoid mpc_proc_clean(void)
30362306a36Sopenharmony_ci{
30462306a36Sopenharmony_ci	remove_proc_entry(STAT_FILE_NAME, atm_proc_root);
30562306a36Sopenharmony_ci}
30662306a36Sopenharmony_ci
30762306a36Sopenharmony_ci#endif /* CONFIG_PROC_FS */
308