lunaix-os/kernel/device.c

   1 #include <klibc/stdio.h>
   2 #include <lunaix/device.h>
   3 #include <lunaix/fs/twifs.h>
   4 #include <lunaix/mm/valloc.h>
   5
   6 struct llist_header dev_list;
   7
   8 static struct twifs_node* dev_root;
   9
  10 int
  11 __dev_read(struct v_file* file, void* buffer, size_t len, size_t fpos);
  12
  13 int
  14 __dev_write(struct v_file* file, void* buffer, size_t len, size_t fpos);
  15
  16 void
  17 device_init()
  18 {
  19     dev_root = twifs_toplevel_node("dev", 3);
  20
  21     llist_init_head(&dev_list);
  22 }
  23
  24 struct device*
  25 device_add(struct device* parent, void* underlay, char* name_fmt, ...)
  26 {
  27     struct device* dev = vzalloc(sizeof(struct device));
  28
  29     va_list args;
  30     va_start(args, name_fmt);
  31
  32     size_t strlen =
  33       __sprintf_internal(dev->name_val, name_fmt, DEVICE_NAME_SIZE, args);
  34
  35     dev->name = HSTR(dev->name_val, strlen);
  36     dev->parent = parent;
  37     dev->underlay = underlay;
  38
  39     hstr_rehash(&dev->name, HSTR_FULL_HASH);
  40     llist_append(&dev_list, &dev->dev_list);
  41
  42     struct twifs_node* dev_node =
  43       twifs_file_node(dev_root, dev->name_val, strlen);
  44     dev_node->data = dev;
  45     dev_node->fops.read = __dev_read;
  46     dev_node->fops.write = __dev_write;
  47
  48     dev->fs_node = dev_node;
  49
  50     va_end(args);
  51     return dev;
  52 }
  53
  54 int
  55 __dev_read(struct v_file* file, void* buffer, size_t len, size_t fpos)
  56 {
  57     struct twifs_node* dev_node = (struct twifs_node*)file->inode->data;
  58     struct device* dev = (struct device*)dev_node->data;
  59
  60     if (!dev->read) {
  61         return ENOTSUP;
  62     }
  63     return dev->read(dev, buffer, fpos, len);
  64 }
  65
  66 int
  67 __dev_write(struct v_file* file, void* buffer, size_t len, size_t fpos)
  68 {
  69     struct twifs_node* dev_node = (struct twifs_node*)file->inode->data;
  70     struct device* dev = (struct device*)dev_node->data;
  71
  72     if (!dev->write) {
  73         return ENOTSUP;
  74     }
  75     return dev->write(dev, buffer, fpos, len);
  76 }
  77
  78 void
  79 device_remove(struct device* dev)
  80 {
  81     llist_delete(&dev->dev_list);
  82     twifs_rm_node((struct twifs_node*)dev->fs_node);
  83     vfree(dev);
  84 }