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