1 files changed, 116 insertions, 0 deletions
diff --git a/arch/m68k/cpu/cw_console_io.c b/arch/m68k/cpu/cw_console_io.c
new file mode 100644
index 0000000000..b0575e4c8a
--- /dev/null
+++ b/arch/m68k/cpu/cw_console_io.c
@@ -0,0 +1,116 @@
+/*
+ * Copyright (c) 2008 Carsten Schlote <c.schlote@konzeptpark.de>
+ * See file CREDITS for list of people who contributed to this project.
+ *
+ * This file is part of U-Boot V2.
+ *
+ * U-Boot V2 is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+ *
+ * U-Boot V2 is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with U-Boot V2.  If not, see <http://www.gnu.org/licenses/>.
+ */
+
+/** @file
+ *  Debug output stubs over BDM for Codewarrior
+ */
+#include <common.h>
+#include <command.h>
+#include <console.h>
+#include <reloc.h>
+#include <init.h>
+
+#ifdef CONFIG_HAS_EARLY_INIT
+
+
+#if 0 // FIXME - make a CW debug port serial driver for u-boot
+
+/*
+ * The result of an I/O command can be any one of the following.
+ */
+typedef enum DSIOResult
+{
+	kDSIONoError	= 0x00,
+	kDSIOError	= 0x01,
+	kDSIOEOF	= 0x02
+} DSIOResult;
+
+/*
+ *	MessageCommandID
+ */
+typedef enum MessageCommandID
+{
+	/*
+	 * target->host support commands
+	 */
+
+	kDSWriteFile	= 0xD0,		/*		L2	L3		*/
+	kDSReadFile	= 0xD1 		/*		L2	L3		*/
+
+} MessageCommandID;
+
+
+enum DSIOResult TransferData(
+	MessageCommandID msg,
+	unsigned char *buffer, int size,
+	int * txsize
+)
+{
+	enum DSIOResult iores = kDSIOError;
+	unsigned long sized2=0;
+
+	/* -- Call codewarrior stub -- */
+	__asm__ __volatile__ (
+"       move.l 	%[cmd],%%d0    \n"
+"       move.l 	#0,%%d1         \n"
+"       move.l 	%[size],%%d2    \n"
+"       move.l 	%[buffer],%%d3  \n"
+"	trap	#14            \n"
+"	move.l	%%d1,%[txsize]  \n"
+"	move.l  %%d0,%[res]     \n"
+	: [res] "=r" (iores), [txsize] "=g" (sized2)
+	: [cmd] "g" (msg), [size] "g" (size), [buffer] "g" (buffer)
+	: "d2","d3" );
+
+	if (txsize!=NULL) *txsize=sized2;
+	return iores;
+}
+
+void *get_early_console_base(const char *name)
+{
+	return (void*)0xdeadbeef;
+}
+
+static unsigned char early_iobuffer[80];
+static int early_iobuffer_cnt;
+
+void early_console_putc(void *base, char c)
+{
+	early_iobuffer[early_iobuffer_cnt++] = c;
+	if ( ( early_iobuffer_cnt >= sizeof(early_iobuffer)) ||
+	     (c == '\n') )
+	{
+		TransferData(kDSWriteFile,early_iobuffer,early_iobuffer_cnt, NULL);
+		early_iobuffer_cnt = 0;
+	}
+}
+
+void early_console_init(void *base, int baudrate)
+{
+	early_iobuffer_cnt = 0;
+}
+
+//void early_console_start(const char *name, int baudrate)
+//{
+//}
+
+#endif
+
+#endif