|
@@ -0,0 +1,378 @@
|
|
|
+/*
|
|
|
+ * File : console.c
|
|
|
+ * This file is part of RT-Thread RTOS
|
|
|
+ * COPYRIGHT (C) 2006, RT-Thread Development Team
|
|
|
+ *
|
|
|
+ * The license and distribution terms for this file may be
|
|
|
+ * found in the file LICENSE in this distribution or at
|
|
|
+ * http://openlab.rt-thread.com/license/LICENSE
|
|
|
+ *
|
|
|
+ * Change Logs:
|
|
|
+ * Date Author Notes
|
|
|
+ * 2006-09-15 QiuYi the first version
|
|
|
+ */
|
|
|
+
|
|
|
+#include <rtthread.h>
|
|
|
+#include <rthw.h>
|
|
|
+
|
|
|
+#include <bsp.h>
|
|
|
+
|
|
|
+
|
|
|
+//#include "serial.h"
|
|
|
+
|
|
|
+static unsigned addr_6845;
|
|
|
+static rt_uint16_t *crt_buf;
|
|
|
+static rt_int16_t crt_pos;
|
|
|
+
|
|
|
+//extern void rt_serial_init(void);
|
|
|
+extern char rt_keyboard_getc(void);
|
|
|
+//extern char rt_serial_getc(void);
|
|
|
+
|
|
|
+static void rt_console_putc(int c);
|
|
|
+
|
|
|
+/**
|
|
|
+ * @addtogroup QEMU
|
|
|
+ */
|
|
|
+/*@{*/
|
|
|
+
|
|
|
+/**
|
|
|
+ * This function initializes cga
|
|
|
+ *
|
|
|
+ */
|
|
|
+void rt_cga_init(void)
|
|
|
+{
|
|
|
+ rt_uint16_t volatile *cp;
|
|
|
+ rt_uint16_t was;
|
|
|
+ rt_uint32_t pos;
|
|
|
+
|
|
|
+ cp = (rt_uint16_t *) (CGA_BUF);
|
|
|
+ was = *cp;
|
|
|
+ *cp = (rt_uint16_t) 0xA55A;
|
|
|
+ if (*cp != 0xA55A)
|
|
|
+ {
|
|
|
+ cp = (rt_uint16_t *) (MONO_BUF);
|
|
|
+ addr_6845 = MONO_BASE;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ *cp = was;
|
|
|
+ addr_6845 = CGA_BASE;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Extract cursor location */
|
|
|
+ outb(addr_6845, 14);
|
|
|
+ pos = inb(addr_6845+1) << 8;
|
|
|
+ outb(addr_6845, 15);
|
|
|
+ pos |= inb(addr_6845+1);
|
|
|
+
|
|
|
+ crt_buf = (rt_uint16_t *)cp;
|
|
|
+ crt_pos = pos;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * This function will write a character to cga
|
|
|
+ *
|
|
|
+ * @param c the char to write
|
|
|
+ */
|
|
|
+static void rt_cga_putc(int c)
|
|
|
+{
|
|
|
+ /* if no attribute given, then use black on white */
|
|
|
+ if (!(c & ~0xff)) c |= 0x0700;
|
|
|
+
|
|
|
+ switch (c & 0xff)
|
|
|
+ {
|
|
|
+ case '\b':
|
|
|
+ if (crt_pos > 0)
|
|
|
+ {
|
|
|
+ crt_pos--;
|
|
|
+ crt_buf[crt_pos] = (c&~0xff) | ' ';
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case '\n':
|
|
|
+ crt_pos += CRT_COLS;
|
|
|
+ /* cascade */
|
|
|
+ case '\r':
|
|
|
+ crt_pos -= (crt_pos % CRT_COLS);
|
|
|
+ break;
|
|
|
+ case '\t':
|
|
|
+ rt_console_putc(' ');
|
|
|
+ rt_console_putc(' ');
|
|
|
+ rt_console_putc(' ');
|
|
|
+ rt_console_putc(' ');
|
|
|
+ rt_console_putc(' ');
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ crt_buf[crt_pos++] = c; /* write the character */
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (crt_pos >= CRT_SIZE)
|
|
|
+ {
|
|
|
+ rt_int32_t i;
|
|
|
+ rt_memcpy(crt_buf, crt_buf + CRT_COLS, (CRT_SIZE - CRT_COLS) << 1);
|
|
|
+ for (i = CRT_SIZE - CRT_COLS; i < CRT_SIZE; i++)
|
|
|
+ crt_buf[i] = 0x0700 | ' ';
|
|
|
+ crt_pos -= CRT_COLS;
|
|
|
+ }
|
|
|
+
|
|
|
+ outb(addr_6845, 14);
|
|
|
+ outb(addr_6845+1, crt_pos >> 8);
|
|
|
+ outb(addr_6845, 15);
|
|
|
+ outb(addr_6845+1, crt_pos);
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * This function will write a character to serial an cga
|
|
|
+ *
|
|
|
+ * @param c the char to write
|
|
|
+ */
|
|
|
+static void rt_console_putc(int c)
|
|
|
+{
|
|
|
+ rt_cga_putc(c);
|
|
|
+// rt_serial_putc(c);
|
|
|
+}
|
|
|
+
|
|
|
+/* RT-Thread Device Interface */
|
|
|
+#define CONSOLE_RX_BUFFER_SIZE 64
|
|
|
+static struct rt_device console_device;
|
|
|
+static rt_uint8_t rx_buffer[CONSOLE_RX_BUFFER_SIZE];
|
|
|
+static rt_uint32_t read_index, save_index;
|
|
|
+
|
|
|
+static rt_err_t rt_console_init (rt_device_t dev)
|
|
|
+{
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+static rt_err_t rt_console_open(rt_device_t dev, rt_uint16_t oflag)
|
|
|
+{
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+static rt_err_t rt_console_close(rt_device_t dev)
|
|
|
+{
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+static rt_err_t rt_console_control(rt_device_t dev, rt_uint8_t cmd, void *args)
|
|
|
+{
|
|
|
+ return RT_EOK;
|
|
|
+}
|
|
|
+
|
|
|
+static rt_size_t rt_console_write(rt_device_t dev, rt_off_t pos, const void * buffer, rt_size_t size)
|
|
|
+{
|
|
|
+ rt_size_t i = size;
|
|
|
+ const char* str = buffer;
|
|
|
+
|
|
|
+ while(i--)
|
|
|
+ {
|
|
|
+ rt_console_putc(*str++);
|
|
|
+ }
|
|
|
+
|
|
|
+ return size;
|
|
|
+}
|
|
|
+
|
|
|
+static rt_size_t rt_console_read(rt_device_t dev, rt_off_t pos, void* buffer, rt_size_t size)
|
|
|
+{
|
|
|
+ rt_uint8_t* ptr = buffer;
|
|
|
+ rt_err_t err_code = RT_EOK;
|
|
|
+
|
|
|
+ /* interrupt mode Rx */
|
|
|
+ while (size)
|
|
|
+ {
|
|
|
+ rt_base_t level;
|
|
|
+
|
|
|
+ /* disable interrupt */
|
|
|
+ level = rt_hw_interrupt_disable();
|
|
|
+
|
|
|
+ if (read_index != save_index)
|
|
|
+ {
|
|
|
+ /* read a character */
|
|
|
+ *ptr++ = rx_buffer[read_index];
|
|
|
+ size--;
|
|
|
+
|
|
|
+ /* move to next position */
|
|
|
+ read_index ++;
|
|
|
+ if (read_index >= CONSOLE_RX_BUFFER_SIZE)
|
|
|
+ read_index = 0;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ /* set error code */
|
|
|
+ err_code = -RT_EEMPTY;
|
|
|
+
|
|
|
+ /* enable interrupt */
|
|
|
+ rt_hw_interrupt_enable(level);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* enable interrupt */
|
|
|
+ rt_hw_interrupt_enable(level);
|
|
|
+ }
|
|
|
+
|
|
|
+ /* set error code */
|
|
|
+ rt_set_errno(err_code);
|
|
|
+ return (rt_uint32_t)ptr - (rt_uint32_t)buffer;
|
|
|
+}
|
|
|
+
|
|
|
+static void rt_console_isr(int vector)
|
|
|
+{
|
|
|
+// rt_kprintf("rt_console_isr\r\n");
|
|
|
+// RT_ASSERT(INTKEYBOARD == vector);
|
|
|
+// finsh_notify();
|
|
|
+
|
|
|
+ char c;
|
|
|
+ rt_base_t level;
|
|
|
+
|
|
|
+ while(1)
|
|
|
+ {
|
|
|
+ c = rt_keyboard_getc();
|
|
|
+// rt_kprintf(" %x", c);
|
|
|
+
|
|
|
+ if(c == 0)
|
|
|
+ {
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ else if(c > 0)
|
|
|
+ {
|
|
|
+ /* disable interrupt */
|
|
|
+ level = rt_hw_interrupt_disable();
|
|
|
+
|
|
|
+ /* save character */
|
|
|
+ rx_buffer[save_index] = c;
|
|
|
+ save_index ++;
|
|
|
+ if (save_index >= CONSOLE_RX_BUFFER_SIZE)
|
|
|
+ save_index = 0;
|
|
|
+
|
|
|
+ /* if the next position is read index, discard this 'read char' */
|
|
|
+ if (save_index == read_index)
|
|
|
+ {
|
|
|
+ read_index ++;
|
|
|
+ if (read_index >= CONSOLE_RX_BUFFER_SIZE)
|
|
|
+ read_index = 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* enable interrupt */
|
|
|
+ rt_hw_interrupt_enable(level);
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ /* invoke callback */
|
|
|
+ if (console_device.rx_indicate != RT_NULL)
|
|
|
+ {
|
|
|
+ rt_size_t rx_length;
|
|
|
+
|
|
|
+ /* get rx length */
|
|
|
+ rx_length = read_index > save_index ?
|
|
|
+ CONSOLE_RX_BUFFER_SIZE - read_index + save_index :
|
|
|
+ save_index - read_index;
|
|
|
+
|
|
|
+// rt_kprintf("\r\nrx_length %d\r\n", rx_length);
|
|
|
+ if(rx_length > 0)
|
|
|
+ {
|
|
|
+ console_device.rx_indicate(&console_device, rx_length);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+// rt_kprintf("\r\nconsole_device.rx_indicate == RT_NULL\r\n");
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * This function initializes console
|
|
|
+ *
|
|
|
+ */
|
|
|
+void rt_hw_console_init(void)
|
|
|
+{
|
|
|
+ rt_cga_init();
|
|
|
+// rt_serial_init();
|
|
|
+
|
|
|
+
|
|
|
+ /* install keyboard isr */
|
|
|
+ rt_hw_interrupt_install(INTKEYBOARD, rt_console_isr, RT_NULL);
|
|
|
+ rt_hw_interrupt_umask(INTKEYBOARD);
|
|
|
+
|
|
|
+ console_device.type = RT_Device_Class_Char;
|
|
|
+ console_device.rx_indicate = RT_NULL;
|
|
|
+ console_device.tx_complete = RT_NULL;
|
|
|
+ console_device.init = rt_console_init;
|
|
|
+ console_device.open = rt_console_open;
|
|
|
+ console_device.close = rt_console_close;
|
|
|
+ console_device.read = rt_console_read;
|
|
|
+ console_device.write = rt_console_write;
|
|
|
+ console_device.control = rt_console_control;
|
|
|
+ console_device.user_data = RT_NULL;
|
|
|
+
|
|
|
+ /* register a character device */
|
|
|
+ rt_device_register(&console_device,
|
|
|
+ "console",
|
|
|
+ RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_INT_RX | RT_DEVICE_FLAG_STREAM);
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * This function is used to display a string on console, normally, it's
|
|
|
+ * invoked by rt_kprintf
|
|
|
+ *
|
|
|
+ * @param str the displayed string
|
|
|
+ *
|
|
|
+ * Modified:
|
|
|
+ * caoxl 2009-10-14
|
|
|
+ * the name is change to rt_hw_console_output in the v0.3.0
|
|
|
+ *
|
|
|
+ */
|
|
|
+
|
|
|
+//void rt_console_puts(const char* str)
|
|
|
+void rt_hw_console_output(const char* str)
|
|
|
+{
|
|
|
+ while (*str)
|
|
|
+ {
|
|
|
+ rt_console_putc (*str++);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+//#define BY2CONS 512
|
|
|
+//
|
|
|
+//static struct
|
|
|
+//{
|
|
|
+// rt_uint8_t buf[BY2CONS];
|
|
|
+// rt_uint32_t rpos;
|
|
|
+// rt_uint32_t wpos;
|
|
|
+//} cons;
|
|
|
+//
|
|
|
+//static void rt_console_intr(char (*proc)(void))
|
|
|
+//{
|
|
|
+// int c;
|
|
|
+//
|
|
|
+// while ((c = (*proc)()) != -1)
|
|
|
+// {
|
|
|
+// if (c == 0)
|
|
|
+// continue;
|
|
|
+// cons.buf[cons.wpos++] = c;
|
|
|
+// if (cons.wpos == BY2CONS)
|
|
|
+// cons.wpos = 0;
|
|
|
+// }
|
|
|
+//}
|
|
|
+
|
|
|
+///**
|
|
|
+// * return the next input character from the console,either from serial,
|
|
|
+// * or keyboard
|
|
|
+// *
|
|
|
+// */
|
|
|
+//int rt_console_getc(void)
|
|
|
+//{
|
|
|
+// int c;
|
|
|
+//
|
|
|
+// rt_console_intr(rt_serial_getc);
|
|
|
+// rt_console_intr(rt_keyboard_getc);
|
|
|
+//
|
|
|
+// if (cons.rpos != cons.wpos)
|
|
|
+// {
|
|
|
+// c = cons.buf[cons.rpos++];
|
|
|
+// if (cons.rpos == BY2CONS)
|
|
|
+// cons.rpos = 0;
|
|
|
+// return c;
|
|
|
+// }
|
|
|
+// return 0;
|
|
|
+//}
|
|
|
+
|
|
|
+/*@}*/
|