/* * Copyright (C) 2004, 2005 Mike Wray * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by the * Free Software Foundation; either version 2 of the License, or (at your * option) any later version. * * This program is distributed in the hope that it will be useful, but * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License * for more details. * * You should have received a copy of the GNU General Public License along * with this program; if not, write to the Free software Foundation, Inc., * 59 Temple Place, suite 330, Boston, MA 02111-1307 USA * */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "vif.h" #include "vnet.h" #include "varp.h" #include "vnet_dev.h" #include "vnet_eval.h" #include "vnet_forward.h" #include "iostream.h" #include "kernel_stream.h" #include "mem_stream.h" #include "sys_string.h" #include "sys_net.h" #include "sxpr_parser.h" #define MODULE_NAME "VNET" #define DEBUG 1 #undef DEBUG #include "debug.h" /** @file * * Kernel interface to files in /proc. * todo: Add a sysfs interface using kobject. */ #define PROC_ROOT "/proc/" #define PROC_ROOT_LEN 6 #define MODULE_ROOT PROC_ROOT "vnet" enum { VNET_POLICY = 1, VNET_VNETS, VNET_VIFS, VNET_VARP, VNET_PEERS, }; typedef struct proc_dir_entry ProcEntry; typedef struct inode Inode; typedef struct file File; static int proc_open_fn(struct inode *inode, File *file); //static ssize_t proc_read_fn(File *file, char *buffer, size_t count, loff_t *offset); //static ssize_t proc_write_fn(File *file, const char *buffer, size_t count, loff_t *offset) ; //static int proc_flush_fn(File *file); static loff_t proc_lseek_fn(File * file, loff_t offset, int orig); static int proc_ioctl_fn(struct inode *inode, File *file, unsigned opcode, unsigned long arg); //static int proc_release_fn(struct inode *inode, File *file); static int ProcEntry_has_name(ProcEntry *entry, const char *name, int namelen){ dprintf("> name=%.*s entry=%.*s\n", namelen, name, entry->namelen, entry->name); if(!entry || !entry->low_ino) return FALSE; if(entry->namelen != namelen) return FALSE; return memcmp(name, entry->name, namelen) == 0; } // Set f->f_error on error? // Does interface stop r/w on first error? // Is release called after an error? // static int proc_get_parser(File *file, Parser **val){ int err = 0; Parser *parser = NULL; parser = file->private_data; if(!parser){ parser = Parser_new(); if(!parser){ err = -ENOMEM; goto exit; } file->private_data = parser; } exit: *val = parser; return err; } static int proc_open_fn(Inode *inode, File *file){ // User open. // Return errcode or 0 on success. // Can stuff data in file->private_data (void*). // Get entry from //ProcEntry *entry = (ProcEntry *)inode->u.generic_ip; //file->private_data = NULL; //file->f_dentry->d_ino is inode. // Check for user privilege - deny otherwise. // -EACCESS int err = 0; dprintf(">\n"); file->private_data = NULL; return err; } static ssize_t proc_read_fn(File *file, char *buffer, size_t count, loff_t *offset){ // User read. // Copy data to user buffer, increment offset by count, return count. dprintf(">\n"); count = 0; //if(copy_to_user(buffer, data, count)){ // return -EFAULT; //} //*offset += count; return count; } #if 0 static ssize_t proc_write_fn(File *file, const char *buffer, size_t count, loff_t *offset) { return -EINVAL; } #endif #if 0 static int proc_flush_fn(File *file){ // User flush. int writing = (file->f_flags & O_ACCMODE) == O_WRONLY; int f_count = atomic_read(&file->f_count); if (writing && f_count == 1) { ProcEntry *pentry = (ProcEntry *)file->f_dentry->d_inode->u.generic_ip; // ... } return retval; } #endif #ifndef SEEK_SET enum { /** Offset from start. */ SEEK_SET = 0, /** Offset from current position. */ SEEK_CUR = 1, /** Offset from size of file. */ SEEK_END = 2 }; #endif /* !SEEK_SET */ static loff_t proc_lseek_fn(File * file, loff_t offset, int from){ // User lseek. dprintf(">\n"); switch(from){ case SEEK_SET: break; case SEEK_CUR: offset += file->f_pos; break; case SEEK_END: return -EINVAL; default: return -EINVAL; } if(offset < 0) return -EINVAL; file->f_pos = offset; return offset; } static int proc_ioctl_fn(Inode *inode, File *file, unsigned opcode, unsigned long arg){ // User ioctl. dprintf(">\n"); return 0; } static ssize_t proc_policy_write_fn(File *file, const char *buffer, size_t count, loff_t *offset) { // User write. // Copy data into kernel space from buffer. // Increment offset by count, return count (or code). int err = 0; char *data = NULL; Parser *parser = NULL; err = proc_get_parser(file, &parser); if(err) goto exit; data = allocate(count); if(!data){ err = -ENOMEM; goto exit; } err = copy_from_user(data, buffer, count); if(err) goto exit; *offset += count; err = Parser_input(parser, data, count); exit: deallocate(data); err = (err < 0 ? err : count); return err; } static int proc_policy_release_fn(Inode *inode, File *file){ // User close. // Cleanup file->private_data, return errcode. int err = 0; Parser *parser = NULL; Sxpr obj, l; dprintf(">\n"); err = proc_get_parser(file, &parser); if(err) goto exit; err = Parser_input(parser, NULL, 0); if(err) goto exit; obj = parser->val; for(l = obj; CONSP(l); l = CDR(l)){ err = vnet_eval(CAR(l), iostdout, NULL); if(err) break; } exit: Parser_free(parser); file->private_data = NULL; dprintf("< err=%d\n", err); return err; } static int proc_io_open(Inode *inode, File *file, IOStream **val){ int err = 0; IOStream *io = mem_stream_new(); if(!io){ err = -ENOMEM; goto exit; } file->private_data = io; exit: *val = (err ? NULL: io); return err; } static ssize_t proc_io_read_fn(File *file, char *buffer, size_t count, loff_t *offset){ // User read. // Copy data to user buffer, increment offset by count, return count. int err = 0; char kbuf[1024] = {}; int kbuf_n = sizeof(kbuf); int k, n = 0; char *ubuf = buffer; IOStream *io = file->private_data; dprintf(">\n"); if(!io) goto exit; while(n < count){ k = count - n; if(k > kbuf_n){ k = kbuf_n; } k = IOStream_read(io, kbuf, k); if(k <= 0) break; if(copy_to_user(ubuf, kbuf, k)){ err = -EFAULT; goto exit; } n += k; ubuf += k; } *offset += n; exit: return (err ? err : n); } static int proc_io_release_fn(Inode *inode, File *file){ // User close. int err = 0; IOStream *io = file->private_data; if(io) IOStream_close(io); dprintf("< err=%d\n", err); return err; } static int proc_vnets_open_fn(Inode *inode, File *file){ int err = 0; IOStream *io; if(proc_io_open(inode, file, &io)) goto exit; vnet_print(io); exit: return err; } static int proc_vifs_open_fn(Inode *inode, File *file){ int err = 0; IOStream *io; if(proc_io_open(inode, file, &io)) goto exit; vif_print(io); exit: return err; } static int proc_peers_open_fn(Inode *inode, File *file){ int err = 0; IOStream *io; if(proc_io_open(inode, file, &io)) goto exit; vnet_peer_print(io); exit: return err; } static int proc_varp_open_fn(Inode *inode, File *file){ int err = 0; IOStream *io; if(proc_io_open(inode, file, &io)) goto exit; varp_print(io); exit: return err; } static struct file_operations proc_policy_ops = { open: proc_open_fn, read: proc_read_fn, write: proc_policy_write_fn, //flush: proc_flush_fn, llseek: proc_lseek_fn, ioctl: proc_ioctl_fn, release: proc_policy_release_fn, }; static struct file_operations proc_vnets_ops = { open: proc_vnets_open_fn, read: proc_io_read_fn, release: proc_io_release_fn, }; static struct file_operations proc_vifs_ops = { open: proc_vifs_open_fn, read: proc_io_read_fn, release: proc_io_release_fn, }; static struct file_operations proc_peers_ops = { open: proc_peers_open_fn, read: proc_io_read_fn, release: proc_io_release_fn, }; static struct file_operations proc_varp_ops = { open: proc_varp_open_fn, read: proc_io_read_fn, release: proc_io_release_fn, }; static ProcEntry *proc_fs_root = &proc_root; static int proc_path_init(const char *path, const char **rest){ int err = 0; if(!path){ err = -EINVAL; goto exit; } if(*path == '/'){ if(strncmp(PROC_ROOT, path, PROC_ROOT_LEN)){ err = -EINVAL; } else { path += PROC_ROOT_LEN; } } exit: *rest = path; return err; } /** Parse a path relative to `dir'. If dir is null or the proc root * the path is relative to "/proc/", and the leading "/proc/" may be * supplied. * */ static ProcEntry * ProcFS_lookup(const char *path, ProcEntry *dir){ const char *pathptr = path, *next = NULL; ProcEntry *entry, *result = NULL; int pathlen; if(dir && (dir != proc_fs_root)){ entry = dir; } else { if(proc_path_init(path, &pathptr)) goto exit; entry = proc_fs_root; } if(!pathptr || !*pathptr) goto exit; while(1){ next = strchr(pathptr, '/'); pathlen = (next ? next - pathptr : strlen(pathptr)); for(entry = entry->subdir; entry ; entry = entry->next) { if(ProcEntry_has_name(entry, pathptr, pathlen)) break; } if (!entry) break; if(!next){ result = entry; break; } pathptr = next + 1; } exit: return result; } static ProcEntry *ProcFS_register(const char *name, ProcEntry *dir, int val, struct file_operations *ops){ mode_t mode = 0; ProcEntry *entry; entry = create_proc_entry(name, mode, dir); if(entry){ entry->proc_fops = ops; entry->data = (void*)val; // Whatever data we need. } return entry; } static ProcEntry *ProcFS_mkdir(const char *name, ProcEntry *parent){ ProcEntry *entry = NULL; entry = ProcFS_lookup(name, parent); if(!entry){ const char *path; if(proc_path_init(name, &path)) goto exit; entry = proc_mkdir(path, parent); } exit: return entry; } static void ProcFS_remove(const char *name, ProcEntry *parent){ remove_proc_entry(name, parent); } static void ProcFS_rmrec_entry(ProcEntry *entry){ if(entry){ // Don't want to remove /proc itself! if(entry->parent == entry) return; while(entry->subdir){ ProcFS_rmrec_entry(entry->subdir); } dprintf("> remove %s\n", entry->name); ProcFS_remove(entry->name, entry->parent); } } static void ProcFS_rmrec(const char *name, ProcEntry *parent){ ProcEntry *entry; dprintf("> name=%s\n", name); entry = ProcFS_lookup(name, parent); if(entry){ ProcFS_rmrec_entry(entry); } dprintf("<\n"); } void __init ProcFS_init(void){ ProcEntry *root_entry; ProcEntry *policy_entry; ProcEntry *vnets_entry; ProcEntry *vifs_entry; ProcEntry *peers_entry; ProcEntry *varp_entry; dprintf(">\n"); root_entry = ProcFS_mkdir(MODULE_ROOT, NULL); if(!root_entry) goto exit; policy_entry = ProcFS_register("policy", root_entry, VNET_POLICY, &proc_policy_ops); vnets_entry = ProcFS_register("vnets", root_entry, VNET_VNETS, &proc_vnets_ops); vifs_entry = ProcFS_register("vifs", root_entry, VNET_VIFS, &proc_vifs_ops); peers_entry = ProcFS_register("peers", root_entry, VNET_PEERS, &proc_peers_ops); varp_entry = ProcFS_register("varp", root_entry, VNET_VARP, &proc_varp_ops); exit: dprintf("<\n"); } void __exit ProcFS_exit(void){ dprintf(">\n"); ProcFS_rmrec(MODULE_ROOT, NULL); dprintf("<\n"); }