feat: nearly complete POSIX.1-2008 compliant terminal interface implementation

[lunaix-os.git] / lunaix-os / kernel / device / device.c

diff --git a/lunaix-os/kernel/device/device.c b/lunaix-os/kernel/device/device.c
index 3647f10a87f778395cb4efba6f4080b622cd0f63..cce51b19dbec4aaf9c3bbc9b94a0e8bddc18b018 100644 (file)
--- a/lunaix-os/kernel/device/device.c
+++ b/lunaix-os/kernel/device/device.c
@@ -1,4 +1,4 @@
-#include <klibc/stdio.h>
+

 #include <lunaix/device.h>
 #include <lunaix/fs.h>
 #include <lunaix/fs/twifs.h>
 #include <lunaix/device.h>
 #include <lunaix/fs.h>
 #include <lunaix/fs/twifs.h>


@@ -8,19 +8,44 @@
 #include <lunaix/syscall.h>
 #include <lunaix/syscall_utils.h>
 
 #include <lunaix/syscall.h>
 #include <lunaix/syscall_utils.h>
 

+#include <klibc/strfmt.h>
+#include <klibc/string.h>
+

 static DEFINE_LLIST(root_list);
 
 static DEFINE_LLIST(root_list);
 

-static volatile dev_t devid = 0;
+static volatile u32_t devid = 0;

 
 

-struct device*
-device_add(struct device* parent,
-           void* underlay,
-           char* name_fmt,
-           u32_t type,
-           va_list args)
+struct devclass default_devclass = {};
+
+void
+device_setname_vargs(struct device* dev, char* fmt, va_list args)

 {
 {

-    struct device* dev = vzalloc(sizeof(struct device));
+    size_t strlen = ksnprintfv(dev->name_val, fmt, DEVICE_NAME_SIZE, args);
+
+    dev->name = HSTR(dev->name_val, strlen);

 
 

+    hstr_rehash(&dev->name, HSTR_FULL_HASH);
+}
+
+void
+device_register(struct device* dev, struct devclass* class, char* fmt, ...)
+{
+    va_list args;
+    va_start(args, fmt);
+
+    if (fmt) {
+        device_setname_vargs(dev, fmt, args);
+    }
+
+    if (class) {
+        dev->ident = (struct devident){ .fn_grp = class->fn_grp,
+                                        .unique = DEV_UNIQUE(class->device,
+                                                             class->variant) };
+    }
+
+    dev->dev_uid = devid++;
+
+    struct device* parent = dev->parent;

     if (parent) {
         assert((parent->dev_type & DEV_MSKIF) == DEV_IFCAT);
         llist_append(&parent->children, &dev->siblings);
     if (parent) {
         assert((parent->dev_type & DEV_MSKIF) == DEV_IFCAT);
         llist_append(&parent->children, &dev->siblings);


@@ -28,46 +53,48 @@ device_add(struct device* parent,
         llist_append(&root_list, &dev->siblings);
     }
 
         llist_append(&root_list, &dev->siblings);
     }
 

-    size_t strlen =
-      __ksprintf_internal(dev->name_val, name_fmt, DEVICE_NAME_SIZE, args);
+    va_end(args);
+}

 
 

+void
+device_create(struct device* dev,
+              struct device* parent,
+              u32_t type,
+              void* underlay)
+{

     dev->magic = DEV_STRUCT_MAGIC;
     dev->magic = DEV_STRUCT_MAGIC;

-    dev->dev_id = devid++;
-    dev->name = HSTR(dev->name_val, strlen);
-    dev->parent = parent;

     dev->underlay = underlay;
     dev->dev_type = type;
     dev->underlay = underlay;
     dev->dev_type = type;

+    dev->parent = parent;

 
 

-    hstr_rehash(&dev->name, HSTR_FULL_HASH);

     llist_init_head(&dev->children);
     llist_init_head(&dev->children);

-
-    return dev;
+    mutex_init(&dev->lock);
+    iopoll_init_evt_q(&dev->pollers);

 }
 
 struct device*
 }
 
 struct device*

-device_addseq(struct device* parent, void* underlay, char* name_fmt, ...)
+device_alloc(struct device* parent, u32_t type, void* underlay)

 {
 {

-    va_list args;
-    va_start(args, name_fmt);
+    struct device* dev = vzalloc(sizeof(struct device));

 
 

-    struct device* dev =
-      device_add(parent, underlay, name_fmt, DEV_IFSEQ, args);
+    if (!dev) {
+        return NULL;
+    }
+
+    device_create(dev, parent, type, underlay);

 
 

-    va_end(args);

     return dev;
 }
 
     return dev;
 }
 

-struct device*
-device_addvol(struct device* parent, void* underlay, char* name_fmt, ...)
+void
+device_setname(struct device* dev, char* fmt, ...)

 {
     va_list args;
 {
     va_list args;

-    va_start(args, name_fmt);
+    va_start(args, fmt);

 
 

-    struct device* dev =
-      device_add(parent, underlay, name_fmt, DEV_IFVOL, args);
+    device_setname_vargs(dev, fmt, args);

 
     va_end(args);
 
     va_end(args);

-    return dev;

 }
 
 struct device*
 }
 
 struct device*


@@ -76,20 +103,23 @@ device_addcat(struct device* parent, char* name_fmt, ...)
     va_list args;
     va_start(args, name_fmt);
 
     va_list args;
     va_start(args, name_fmt);
 

-    struct device* dev = device_add(parent, NULL, name_fmt, DEV_IFCAT, args);
+    struct device* dev = device_alloc(parent, DEV_IFCAT, NULL);
+
+    device_setname_vargs(dev, name_fmt, args);
+    device_register(dev, NULL, NULL);

 
     va_end(args);
     return dev;
 }
 
 struct device*
 
     va_end(args);
     return dev;
 }
 
 struct device*

-device_getbyid(struct llist_header* devlist, dev_t id)
+device_getbyid(struct llist_header* devlist, u32_t id)

 {
     devlist = devlist ? devlist : &root_list;
     struct device *pos, *n;
     llist_for_each(pos, n, devlist, siblings)
     {
 {
     devlist = devlist ? devlist : &root_list;
     struct device *pos, *n;
     llist_for_each(pos, n, devlist, siblings)
     {

-        if (pos->dev_id == id) {
+        if (pos->dev_uid == id) {

             return pos;
         }
     }
             return pos;
         }
     }


@@ -143,26 +173,67 @@ device_getbyoffset(struct device* root_dev, int offset)
     return NULL;
 }
 
     return NULL;
 }
 

+void
+device_populate_info(struct device* dev, struct dev_info* devinfo)
+{
+    devinfo->dev_id.group = dev->ident.fn_grp;
+    devinfo->dev_id.unique = dev->ident.unique;
+
+    if (!devinfo->dev_name.buf) {
+        return;
+    }
+
+    struct device_def* def = devdef_byident(&dev->ident);
+    size_t buflen = devinfo->dev_name.buf_len;
+
+    strncpy(devinfo->dev_name.buf, def->name, buflen);
+    devinfo->dev_name.buf[buflen - 1] = 0;
+}
+
+struct device*
+device_cast(void* obj)
+{
+    struct device* dev = (struct device*)obj;
+    if (dev && dev->magic == DEV_STRUCT_MAGIC) {
+        return dev;
+    }
+
+    return NULL;
+}
+
+void
+device_alert_poller(struct device* dev, int poll_evt)
+{
+    dev->poll_evflags = poll_evt;
+    iopoll_wake_pollers(&dev->pollers);
+}
+

 __DEFINE_LXSYSCALL3(int, ioctl, int, fd, int, req, va_list, args)
 {
 __DEFINE_LXSYSCALL3(int, ioctl, int, fd, int, req, va_list, args)
 {

-    int errno;
+    int errno = -1;

     struct v_fd* fd_s;
     struct v_fd* fd_s;

-    if ((errno = vfs_getfd(fd, &fd_s))) {
+    if ((errno &= vfs_getfd(fd, &fd_s))) {

         goto done;
     }
 
     struct device* dev = (struct device*)fd_s->file->inode->data;
     if (dev->magic != DEV_STRUCT_MAGIC) {
         goto done;
     }
 
     struct device* dev = (struct device*)fd_s->file->inode->data;
     if (dev->magic != DEV_STRUCT_MAGIC) {

-        errno = ENODEV;
+        errno &= ENODEV;

         goto done;
     }
 
         goto done;
     }
 

-    if (!dev->exec_cmd) {
-        errno = EINVAL;
+    if (req == DEVIOIDENT) {
+        struct dev_info* devinfo = va_arg(args, struct dev_info*);
+        device_populate_info(dev, devinfo);
+        errno = 0;
+    }
+
+    if (!dev->ops.exec_cmd) {
+        errno &= ENOTSUP;

         goto done;
     }
 
         goto done;
     }
 

-    errno = dev->exec_cmd(dev, req, args);
+    errno &= dev->ops.exec_cmd(dev, req, args);

 
 done:
     return DO_STATUS_OR_RETURN(errno);
 
 done:
     return DO_STATUS_OR_RETURN(errno);