WebSVN – HelenOS – Diff – /branches/network/kernel/generic/src/console/console.c

 #include <synch/waitq.h>
 #include <synch/spinlock.h>
 #include <arch/types.h>
 #include <ddi/irq.h>
 #include <ddi/ddi.h>
+#include <ipc/event.h>
 #include <ipc/irq.h>
 #include <arch.h>
 #include <func.h>
 #include <print.h>
+#include <putchar.h>
 #include <atomic.h>
 #include <syscall/copy.h>
 #include <errno.h>
+#include <string.h>
-#define KLOG_SIZE PAGE_SIZE
+#define KLOG_PAGES    4
+#define KLOG_LENGTH   (KLOG_PAGES * PAGE_SIZE / sizeof(wchar_t))
-#define KLOG_LATENCY 8
+#define KLOG_LATENCY  8
 /** Kernel log cyclic buffer */
-static char klog[KLOG_SIZE] __attribute__ ((aligned (PAGE_SIZE)));
+static wchar_t klog[KLOG_LENGTH] __attribute__ ((aligned (PAGE_SIZE)));
 /** Kernel log initialized */
 static bool klog_inited = false;
 /** First kernel log characters */
 static index_t klog_start = 0;
 void klog_init(void)
+{
     void *faddr = (void *) KA2PA(klog);
     ASSERT((uintptr_t) faddr % FRAME_SIZE == 0);
-    ASSERT(KLOG_SIZE % FRAME_SIZE == 0);
     klog_parea.pbase = (uintptr_t) faddr;
-    klog_parea.frames = SIZE2FRAMES(KLOG_SIZE);
+    klog_parea.frames = SIZE2FRAMES(sizeof(klog));
     ddi_parea_register(&klog_parea);
     sysinfo_set_item_val("klog.faddr", NULL, (unative_t) faddr);
-    sysinfo_set_item_val("klog.pages", NULL, SIZE2FRAMES(KLOG_SIZE));
+    sysinfo_set_item_val("klog.pages", NULL, KLOG_PAGES);
-    //irq_initialize(&klog_irq);
-    //klog_irq.devno = devno;
-    //klog_irq.inr = KLOG_VIRT_INR;
-    //klog_irq.claim = klog_claim;
-    //irq_register(&klog_irq);
     spinlock_lock(&klog_lock);
     klog_inited = true;
     spinlock_unlock(&klog_lock);
+}
+ *
  * @param indev Input character device.
  * @return Character read.
+ *
  */
-uint8_t _getc(indev_t *indev)
+wchar_t _getc(indev_t *indev)
+{
     if (atomic_get(&haltstate)) {
         /* If we are here, we are hopefully on the processor that
          * issued the 'halt' command, so proceed to read the character
          * directly from input
+    }
     waitq_sleep(&indev->wq);
     ipl_t ipl = interrupts_disable();
     spinlock_lock(&indev->lock);
-    uint8_t ch = indev->buffer[(indev->index - indev->counter) % INDEV_BUFLEN];
+    wchar_t ch = indev->buffer[(indev->index - indev->counter) % INDEV_BUFLEN];
     indev->counter--;
     spinlock_unlock(&indev->lock);
     interrupts_restore(ipl);
     return ch;
+ *
  * Read characters from input character device until first occurrence
  * of newline character.
+ *
  * @param indev  Input character device.
- * @param buf    Buffer where to store string terminated by '\0'.
+ * @param buf    Buffer where to store string terminated by NULL.
  * @param buflen Size of the buffer.
+ *
  * @return Number of characters read.
+ *
  */
 count_t gets(indev_t *indev, char *buf, size_t buflen)
+{
-    index_t index = 0;
+    size_t offset = 0;
+    count_t count = 0;
+    buf[offset] = 0;
-    while (index < buflen) {
+    wchar_t ch;
-        char ch = _getc(indev);
+    while ((ch = _getc(indev)) != '\n') {
         if (ch == '\b') {
-            if (index > 0) {
+            if (count > 0) {
-                index--;
-                /* Space backspace, space */
+                /* Space, backspace, space */
                 putchar('\b');
                 putchar(' ');
                 putchar('\b');
+                count--;
+                offset = str_lsize(buf, count);
+                buf[offset] = 0;
+            }
-            continue;
-        }
-        putchar(ch);
-        if (ch == '\n') { /* end of string => write 0, return */
-            buf[index] = '\0';
-            return (count_t) index;
+        }
+        if (chr_encode(ch, buf, &offset, buflen - 1) == EOK) {
+            putchar(ch);
+            count++;
-        buf[index++] = ch;
+            buf[offset] = 0;
+        }
+    }
-    return (count_t) index;
+    return count;
+}
 /** Get character from input device & echo it to screen */
-uint8_t getc(indev_t *indev)
+wchar_t getc(indev_t *indev)
+{
-    uint8_t ch = _getc(indev);
+    wchar_t ch = _getc(indev);
     putchar(ch);
     return ch;
+}
 void klog_update(void)
+{
     spinlock_lock(&klog_lock);
-//  if ((klog_inited) && (klog_irq.notif_cfg.notify) && (klog_uspace > 0)) {
+    if ((klog_inited) && (event_is_subscribed(EVENT_KLOG)) && (klog_uspace > 0)) {
-//      ipc_irq_send_msg_3(&klog_irq, klog_start, klog_len, klog_uspace);
+        event_notify_3(EVENT_KLOG, klog_start, klog_len, klog_uspace);
-//      klog_uspace = 0;
+        klog_uspace = 0;
-//  }
+    }
     spinlock_unlock(&klog_lock);
+}
-void putchar(char c)
+void putchar(const wchar_t ch)
+{
     spinlock_lock(&klog_lock);
     if ((klog_stored > 0) && (stdout) && (stdout->op->write)) {
         /* Print charaters stored in kernel log */
         index_t i;
         for (i = klog_len - klog_stored; i < klog_len; i++)
-            stdout->op->write(stdout, klog[(klog_start + i) % KLOG_SIZE], silent);
+            stdout->op->write(stdout, klog[(klog_start + i) % KLOG_LENGTH], silent);
         klog_stored = 0;
+    }
     /* Store character in the cyclic kernel log */
-    klog[(klog_start + klog_len) % KLOG_SIZE] = c;
+    klog[(klog_start + klog_len) % KLOG_LENGTH] = ch;
-    if (klog_len < KLOG_SIZE)
+    if (klog_len < KLOG_LENGTH)
         klog_len++;
     else
-        klog_start = (klog_start + 1) % KLOG_SIZE;
+        klog_start = (klog_start + 1) % KLOG_LENGTH;
     if ((stdout) && (stdout->op->write))
-        stdout->op->write(stdout, c, silent);
+        stdout->op->write(stdout, ch, silent);
     else {
         /* The character is just in the kernel log */
         if (klog_stored < klog_len)
             klog_stored++;
+    }
     if (klog_uspace < klog_len)
         klog_uspace++;
     /* Check notify uspace to update */
     bool update;
-    if ((klog_uspace > KLOG_LATENCY) || (c == '\n'))
+    if ((klog_uspace > KLOG_LATENCY) || (ch == '\n'))
         update = true;
     else
         update = false;
     spinlock_unlock(&klog_lock);
 /** Print using kernel facility
+ *
  * Print to kernel log.
+ *
  */
-unative_t sys_klog(int fd, const void * buf, size_t count)
+unative_t sys_klog(int fd, const void *buf, size_t size)
+{
     char *data;
     int rc;
-    if (count > PAGE_SIZE)
+    if (size > PAGE_SIZE)
         return ELIMIT;
-    if (count > 0) {
+    if (size > 0) {
-        data = (char *) malloc(count + 1, 0);
+        data = (char *) malloc(size + 1, 0);
         if (!data)
             return ENOMEM;
-        rc = copy_from_uspace(data, buf, count);
+        rc = copy_from_uspace(data, buf, size);
         if (rc) {
             free(data);
             return rc;
+        }
-        data[count] = 0;
+        data[size] = 0;
         printf("%s", data);
         free(data);
     } else
         klog_update();
-    return count;
+    return size;
+}
 /** @}
  */

Subversion Repositories HelenOS

(root)/branches/network/kernel/generic/src/console/console.c – Rev 4153 → 4263