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