1 /* This program is free software; you can redistribute it and/or modify 2 * it under the terms of the GNU General Public License version 2 3 * as published by the Free Software Foundation. 4 * 5 * This program is distributed in the hope that it will be useful, 6 * but WITHOUT ANY WARRANTY; without even the implied warranty of 7 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 8 * GNU General Public License for more details. 9 * 10 * Authors: 11 * (C) 2015 Pengutronix, Alexander Aring <aar@pengutronix.de> 12 * Copyright (c) 2015 Nordic Semiconductor. All Rights Reserved. 13 */ 14 15 #include <net/6lowpan.h> 16 17 #include "6lowpan_i.h" 18 19 #define LOWPAN_DEBUGFS_CTX_PFX_NUM_ARGS 8 20 21 static struct dentry *lowpan_debugfs; 22 23 static int lowpan_ctx_flag_active_set(void *data, u64 val) 24 { 25 struct lowpan_iphc_ctx *ctx = data; 26 27 if (val != 0 && val != 1) 28 return -EINVAL; 29 30 if (val) 31 set_bit(LOWPAN_IPHC_CTX_FLAG_ACTIVE, &ctx->flags); 32 else 33 clear_bit(LOWPAN_IPHC_CTX_FLAG_ACTIVE, &ctx->flags); 34 35 return 0; 36 } 37 38 static int lowpan_ctx_flag_active_get(void *data, u64 *val) 39 { 40 *val = lowpan_iphc_ctx_is_active(data); 41 return 0; 42 } 43 44 DEFINE_DEBUGFS_ATTRIBUTE(lowpan_ctx_flag_active_fops, 45 lowpan_ctx_flag_active_get, 46 lowpan_ctx_flag_active_set, "%llu\n"); 47 48 static int lowpan_ctx_flag_c_set(void *data, u64 val) 49 { 50 struct lowpan_iphc_ctx *ctx = data; 51 52 if (val != 0 && val != 1) 53 return -EINVAL; 54 55 if (val) 56 set_bit(LOWPAN_IPHC_CTX_FLAG_COMPRESSION, &ctx->flags); 57 else 58 clear_bit(LOWPAN_IPHC_CTX_FLAG_COMPRESSION, &ctx->flags); 59 60 return 0; 61 } 62 63 static int lowpan_ctx_flag_c_get(void *data, u64 *val) 64 { 65 *val = lowpan_iphc_ctx_is_compression(data); 66 return 0; 67 } 68 69 DEFINE_DEBUGFS_ATTRIBUTE(lowpan_ctx_flag_c_fops, lowpan_ctx_flag_c_get, 70 lowpan_ctx_flag_c_set, "%llu\n"); 71 72 static int lowpan_ctx_plen_set(void *data, u64 val) 73 { 74 struct lowpan_iphc_ctx *ctx = data; 75 struct lowpan_iphc_ctx_table *t = 76 container_of(ctx, struct lowpan_iphc_ctx_table, table[ctx->id]); 77 78 if (val > 128) 79 return -EINVAL; 80 81 spin_lock_bh(&t->lock); 82 ctx->plen = val; 83 spin_unlock_bh(&t->lock); 84 85 return 0; 86 } 87 88 static int lowpan_ctx_plen_get(void *data, u64 *val) 89 { 90 struct lowpan_iphc_ctx *ctx = data; 91 struct lowpan_iphc_ctx_table *t = 92 container_of(ctx, struct lowpan_iphc_ctx_table, table[ctx->id]); 93 94 spin_lock_bh(&t->lock); 95 *val = ctx->plen; 96 spin_unlock_bh(&t->lock); 97 return 0; 98 } 99 100 DEFINE_DEBUGFS_ATTRIBUTE(lowpan_ctx_plen_fops, lowpan_ctx_plen_get, 101 lowpan_ctx_plen_set, "%llu\n"); 102 103 static int lowpan_ctx_pfx_show(struct seq_file *file, void *offset) 104 { 105 struct lowpan_iphc_ctx *ctx = file->private; 106 struct lowpan_iphc_ctx_table *t = 107 container_of(ctx, struct lowpan_iphc_ctx_table, table[ctx->id]); 108 109 spin_lock_bh(&t->lock); 110 seq_printf(file, "%04x:%04x:%04x:%04x:%04x:%04x:%04x:%04x\n", 111 be16_to_cpu(ctx->pfx.s6_addr16[0]), 112 be16_to_cpu(ctx->pfx.s6_addr16[1]), 113 be16_to_cpu(ctx->pfx.s6_addr16[2]), 114 be16_to_cpu(ctx->pfx.s6_addr16[3]), 115 be16_to_cpu(ctx->pfx.s6_addr16[4]), 116 be16_to_cpu(ctx->pfx.s6_addr16[5]), 117 be16_to_cpu(ctx->pfx.s6_addr16[6]), 118 be16_to_cpu(ctx->pfx.s6_addr16[7])); 119 spin_unlock_bh(&t->lock); 120 121 return 0; 122 } 123 124 static int lowpan_ctx_pfx_open(struct inode *inode, struct file *file) 125 { 126 return single_open(file, lowpan_ctx_pfx_show, inode->i_private); 127 } 128 129 static ssize_t lowpan_ctx_pfx_write(struct file *fp, 130 const char __user *user_buf, size_t count, 131 loff_t *ppos) 132 { 133 char buf[128] = {}; 134 struct seq_file *file = fp->private_data; 135 struct lowpan_iphc_ctx *ctx = file->private; 136 struct lowpan_iphc_ctx_table *t = 137 container_of(ctx, struct lowpan_iphc_ctx_table, table[ctx->id]); 138 int status = count, n, i; 139 unsigned int addr[8]; 140 141 if (copy_from_user(&buf, user_buf, min_t(size_t, sizeof(buf) - 1, 142 count))) { 143 status = -EFAULT; 144 goto out; 145 } 146 147 n = sscanf(buf, "%04x:%04x:%04x:%04x:%04x:%04x:%04x:%04x", 148 &addr[0], &addr[1], &addr[2], &addr[3], &addr[4], 149 &addr[5], &addr[6], &addr[7]); 150 if (n != LOWPAN_DEBUGFS_CTX_PFX_NUM_ARGS) { 151 status = -EINVAL; 152 goto out; 153 } 154 155 spin_lock_bh(&t->lock); 156 for (i = 0; i < 8; i++) 157 ctx->pfx.s6_addr16[i] = cpu_to_be16(addr[i] & 0xffff); 158 spin_unlock_bh(&t->lock); 159 160 out: 161 return status; 162 } 163 164 static const struct file_operations lowpan_ctx_pfx_fops = { 165 .open = lowpan_ctx_pfx_open, 166 .read = seq_read, 167 .write = lowpan_ctx_pfx_write, 168 .llseek = seq_lseek, 169 .release = single_release, 170 }; 171 172 static int lowpan_dev_debugfs_ctx_init(struct net_device *dev, 173 struct dentry *ctx, u8 id) 174 { 175 struct lowpan_dev *ldev = lowpan_dev(dev); 176 struct dentry *dentry, *root; 177 char buf[32]; 178 179 WARN_ON_ONCE(id > LOWPAN_IPHC_CTX_TABLE_SIZE); 180 181 sprintf(buf, "%d", id); 182 183 root = debugfs_create_dir(buf, ctx); 184 if (!root) 185 return -EINVAL; 186 187 dentry = debugfs_create_file_unsafe("active", 0644, root, 188 &ldev->ctx.table[id], 189 &lowpan_ctx_flag_active_fops); 190 if (!dentry) 191 return -EINVAL; 192 193 dentry = debugfs_create_file_unsafe("compression", 0644, root, 194 &ldev->ctx.table[id], 195 &lowpan_ctx_flag_c_fops); 196 if (!dentry) 197 return -EINVAL; 198 199 dentry = debugfs_create_file("prefix", 0644, root, 200 &ldev->ctx.table[id], 201 &lowpan_ctx_pfx_fops); 202 if (!dentry) 203 return -EINVAL; 204 205 dentry = debugfs_create_file_unsafe("prefix_len", 0644, root, 206 &ldev->ctx.table[id], 207 &lowpan_ctx_plen_fops); 208 if (!dentry) 209 return -EINVAL; 210 211 return 0; 212 } 213 214 static int lowpan_context_show(struct seq_file *file, void *offset) 215 { 216 struct lowpan_iphc_ctx_table *t = file->private; 217 int i; 218 219 seq_printf(file, "%3s|%-43s|%c\n", "cid", "prefix", 'C'); 220 seq_puts(file, "-------------------------------------------------\n"); 221 222 spin_lock_bh(&t->lock); 223 for (i = 0; i < LOWPAN_IPHC_CTX_TABLE_SIZE; i++) { 224 if (!lowpan_iphc_ctx_is_active(&t->table[i])) 225 continue; 226 227 seq_printf(file, "%3d|%39pI6c/%-3d|%d\n", t->table[i].id, 228 &t->table[i].pfx, t->table[i].plen, 229 lowpan_iphc_ctx_is_compression(&t->table[i])); 230 } 231 spin_unlock_bh(&t->lock); 232 233 return 0; 234 } 235 DEFINE_SHOW_ATTRIBUTE(lowpan_context); 236 237 static int lowpan_short_addr_get(void *data, u64 *val) 238 { 239 struct wpan_dev *wdev = data; 240 241 rtnl_lock(); 242 *val = le16_to_cpu(wdev->short_addr); 243 rtnl_unlock(); 244 245 return 0; 246 } 247 248 DEFINE_DEBUGFS_ATTRIBUTE(lowpan_short_addr_fops, lowpan_short_addr_get, NULL, 249 "0x%04llx\n"); 250 251 static int lowpan_dev_debugfs_802154_init(const struct net_device *dev, 252 struct lowpan_dev *ldev) 253 { 254 struct dentry *dentry, *root; 255 256 if (!lowpan_is_ll(dev, LOWPAN_LLTYPE_IEEE802154)) 257 return 0; 258 259 root = debugfs_create_dir("ieee802154", ldev->iface_debugfs); 260 if (!root) 261 return -EINVAL; 262 263 dentry = debugfs_create_file_unsafe("short_addr", 0444, root, 264 lowpan_802154_dev(dev)->wdev->ieee802154_ptr, 265 &lowpan_short_addr_fops); 266 if (!dentry) 267 return -EINVAL; 268 269 return 0; 270 } 271 272 int lowpan_dev_debugfs_init(struct net_device *dev) 273 { 274 struct lowpan_dev *ldev = lowpan_dev(dev); 275 struct dentry *contexts, *dentry; 276 int ret, i; 277 278 /* creating the root */ 279 ldev->iface_debugfs = debugfs_create_dir(dev->name, lowpan_debugfs); 280 if (!ldev->iface_debugfs) 281 goto fail; 282 283 contexts = debugfs_create_dir("contexts", ldev->iface_debugfs); 284 if (!contexts) 285 goto remove_root; 286 287 dentry = debugfs_create_file("show", 0644, contexts, 288 &lowpan_dev(dev)->ctx, 289 &lowpan_context_fops); 290 if (!dentry) 291 goto remove_root; 292 293 for (i = 0; i < LOWPAN_IPHC_CTX_TABLE_SIZE; i++) { 294 ret = lowpan_dev_debugfs_ctx_init(dev, contexts, i); 295 if (ret < 0) 296 goto remove_root; 297 } 298 299 ret = lowpan_dev_debugfs_802154_init(dev, ldev); 300 if (ret < 0) 301 goto remove_root; 302 303 return 0; 304 305 remove_root: 306 lowpan_dev_debugfs_exit(dev); 307 fail: 308 return -EINVAL; 309 } 310 311 void lowpan_dev_debugfs_exit(struct net_device *dev) 312 { 313 debugfs_remove_recursive(lowpan_dev(dev)->iface_debugfs); 314 } 315 316 int __init lowpan_debugfs_init(void) 317 { 318 lowpan_debugfs = debugfs_create_dir("6lowpan", NULL); 319 if (!lowpan_debugfs) 320 return -EINVAL; 321 322 return 0; 323 } 324 325 void lowpan_debugfs_exit(void) 326 { 327 debugfs_remove_recursive(lowpan_debugfs); 328 } 329