Diff: mrubyc/console.c

Revision:

0:33feccbba3ff

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/mrubyc/console.c	Wed Feb 15 01:03:35 2017 +0000
@@ -0,0 +1,211 @@
+/*! @file
+  @brief
+  console I/O module.
+
+  <pre>
+  Copyright (C) 2015 Kyushu Institute of Technology.
+  Copyright (C) 2015 Shimane IT Open-Innovation Center.
+
+  This file is distributed under BSD 3-Clause License.
+
+  </pre>
+*/
+
+#include <stdarg.h>
+#include <string.h>
+#include <stdint.h>
+#include "hal/hal.h"
+#include "console.h"
+
+
+//================================================================
+/*! output string with format
+
+  @param  value		output value
+  @param  align		left(-1) or right(1)
+  @param  w		width
+  @param  base		n base
+  @param  pad		padding character
+*/
+static void format_output_str(const char *value, int align, int w, char pad)
+{
+  if( !value ) return;
+
+  int len = strlen(value);
+  int n_pad = w - len;
+
+  if( align == 1 ) {
+    while( n_pad-- > 0 ) {
+      console_putchar(pad);
+    }
+  }
+  hal_write(1, value, len);
+  while( n_pad-- > 0 ) {
+    console_putchar(pad);
+  }
+}
+
+
+//================================================================
+/*! output int value with format
+
+  @param  value		output value
+  @param  align		left(-1) or right(1)
+  @param  w		width
+  @param  base		n base
+  @param  pad		padding character
+*/
+static void format_output_int(int32_t value, int align, int w, int base, char pad)
+{
+  char buf[21];
+  int sign = 0;
+  int idx = sizeof(buf);
+  buf[--idx] = 0;
+
+  if( value < 0 ) {
+    sign  = -1;
+    value = -value;
+  }
+
+  do {
+    buf[--idx] = "0123456789ABCDEF"[value % base];
+    value /= base;
+  } while( value != 0 && idx != 0 );
+
+  if( sign < 0 && align > 0 && pad == '0' ) {
+    console_putchar('-');	// when "%08d",-12345 then "-0012345"
+    w--;
+  } else if( sign < 0 && idx != 0 ) {
+    buf[--idx] = '-';
+  }
+
+  format_output_str(buf + idx, align, w, pad);
+}
+
+
+//================================================================
+/*! output unsigned int value with format
+
+  @param  value		output value
+  @param  align		left(-1) or right(1)
+  @param  w		width
+  @param  base		n base
+  @param  pad		padding character
+*/
+static void format_output_uint(uint32_t value, int align, int w, int base, char pad)
+{
+  char buf[21];
+  int idx = sizeof(buf);
+  buf[--idx] = 0;
+
+  do {
+    buf[--idx] = "0123456789ABCDEF"[value % base];
+    value /= base;
+  } while( value != 0 && idx != 0 );
+
+  format_output_str(buf + idx, align, w, pad);
+}
+
+
+//================================================================
+/*! output a character
+
+  @param  c	character
+*/
+void console_putchar(char c)
+{
+  hal_write(1, &c, 1);
+}
+
+
+//================================================================
+/*! output string
+
+  @param str	str
+*/
+void console_print(const char *str)
+{
+  hal_write(1, str, strlen(str));
+}
+
+
+//================================================================
+/*! output formatted string
+
+  @param  fmt		format string.
+  @note
+*/
+void console_printf(const char *fmt, ...)
+{
+  va_list params;
+  va_start(params, fmt);
+
+  int c;
+  while((c = *fmt++)) {
+    if( c != '%' ) {
+      console_putchar(c);
+      continue;
+    }
+
+    int  align = 1;	// left(-1) or right(1)
+    char pad   = ' ';	// padding
+    int  w     = 0;	// width
+    while( 1 ) {
+      switch( (c = *fmt++) ) {
+      case '-':
+        align = -1;
+        break;
+
+      case '0':
+        if( pad == ' ' ) {
+          pad = '0';
+          break;
+        }
+	// fall through.
+
+      case '1': case '2': case '3': case '4': case '5':
+      case '6': case '7': case '8': case '9':
+        w = w * 10 + (c - '0');
+        break;
+
+      case '\0':
+	goto L_return;
+
+      default:
+        goto L_exit;
+      }
+    }
+
+L_exit:
+    switch(c) {
+    case 's':
+      format_output_str(va_arg(params, char *), align, w, pad);
+      break;
+
+    case 'd':
+    case 'i':
+      format_output_int(va_arg(params, int), align, w, 10, pad);
+      break;
+
+    case 'u':
+      format_output_uint(va_arg(params, unsigned int), align, w, 10, pad);
+      break;
+
+    case 'X':
+    case 'x':
+      format_output_uint(va_arg(params, unsigned int), align, w, 16, pad);
+      break;
+
+    case 'c':
+      console_putchar(va_arg(params, int));	// ignore "%03c" and others.
+      break;
+
+    default:
+      console_putchar(c);
+    }
+  }
+
+L_return:
+  va_end(params);
+}
+