[Feature]add MT2731_MP2_MR2_SVN388 baseline version
Change-Id: Ief04314834b31e27effab435d3ca8ba33b499059
diff --git a/src/bsp/lk/platform/pc/debug.c b/src/bsp/lk/platform/pc/debug.c
new file mode 100644
index 0000000..e7d0e05
--- /dev/null
+++ b/src/bsp/lk/platform/pc/debug.c
@@ -0,0 +1,121 @@
+/*
+ * Copyright (c) 2009 Corey Tabaka
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining
+ * a copy of this software and associated documentation files
+ * (the "Software"), to deal in the Software without restriction,
+ * including without limitation the rights to use, copy, modify, merge,
+ * publish, distribute, sublicense, and/or sell copies of the Software,
+ * and to permit persons to whom the Software is furnished to do so,
+ * subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be
+ * included in all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
+ * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
+ * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
+ * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
+ * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
+ * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
+ */
+#include <stdarg.h>
+#include <reg.h>
+#include <stdio.h>
+#include <kernel/thread.h>
+#include <arch/x86.h>
+#include <lib/cbuf.h>
+#include <platform/interrupts.h>
+#include <platform/pc/memmap.h>
+#include <platform/console.h>
+#include <platform/keyboard.h>
+#include <platform/debug.h>
+
+static int uart_baud_rate = 115200;
+static int uart_io_port = 0x3f8;
+
+static cbuf_t uart_rx_buf;
+
+static enum handler_return uart_irq_handler(void *arg)
+{
+ unsigned char c;
+ bool resched = false;
+
+ while (inp(uart_io_port + 5) & (1<<0)) {
+ c = inp(uart_io_port + 0);
+ cbuf_write_char(&uart_rx_buf, c, false);
+ resched = true;
+ }
+
+ return resched ? INT_RESCHEDULE : INT_NO_RESCHEDULE;
+}
+
+void platform_init_uart(void)
+{
+ /* configure the uart */
+ int divisor = 115200 / uart_baud_rate;
+
+ /* get basic config done so that tx functions */
+ outp(uart_io_port + 3, 0x80); // set up to load divisor latch
+ outp(uart_io_port + 0, divisor & 0xff); // lsb
+ outp(uart_io_port + 1, divisor >> 8); // msb
+ outp(uart_io_port + 3, 3); // 8N1
+ outp(uart_io_port + 2, 0x07); // enable FIFO, clear, 14-byte threshold
+}
+
+void uart_init(void)
+{
+ /* finish uart init to get rx going */
+ cbuf_initialize(&uart_rx_buf, 16);
+
+ register_int_handler(0x24, uart_irq_handler, NULL);
+ unmask_interrupt(0x24);
+
+ outp(uart_io_port + 1, 0x1); // enable receive data available interrupt
+}
+
+void uart_putc(char c)
+{
+ while ((inp(uart_io_port + 5) & (1<<6)) == 0)
+ ;
+ outp(uart_io_port + 0, c);
+}
+
+int uart_getc(char *c, bool wait)
+{
+ return cbuf_read_char(&uart_rx_buf, c, wait);
+}
+
+void platform_dputc(char c)
+{
+ if (c == '\n')
+ platform_dputc('\r');
+#if WITH_CGA_CONSOLE
+ cputc(c);
+#else
+ uart_putc(c);
+#endif
+}
+
+int platform_dgetc(char *c, bool wait)
+{
+#if WITH_CGA_CONSOLE
+ int ret = platform_read_key(c);
+ //if (ret < 0)
+ // arch_idle();
+#else
+ int ret = uart_getc(c, wait);
+#endif
+
+ return ret;
+}
+
+void platform_halt(void)
+{
+ for (;;) {
+ x86_cli();
+ x86_hlt();
+ }
+}
+