1 files changed, 69 insertions, 0 deletions
diff --git a/ns.c b/ns.c
new file mode 100644
index 0000000..28f4376
--- /dev/null
+++ b/ns.c
@@ -0,0 +1,69 @@
+/*
+ * ns.c - code to initialise everything required when first booting.
+ *
+ * Copyright (C) 2015 ARM Limited. All rights reserved.
+ *
+ * Use of this source code is governed by a BSD-style license that can be
+ * found in the LICENSE.txt file.
+ */
+
+#include <stdint.h>
+
+#include <asm/io.h>
+
+#define PL011_UARTDR		0x00
+#define PL011_UARTFR		0x18
+#define PL011_UARTIBRD		0x24
+#define PL011_UARTFBRD		0x28
+#define PL011_UART_LCR_H	0x2c
+#define PL011_UARTCR		0x30
+
+#define PL011_UARTFR_BUSY	(1 << 3)
+#define PL011_UARTFR_FIFO_FULL	(1 << 5)
+
+#define PL011(reg)	((void *)UART_BASE + PL011_##reg)
+
+#define V2M_SYS_CFGDATA		0xa0
+#define V2M_SYS_CFGCTRL		0xa4
+
+#define V2M_SYS(reg)	((void *)SYSREGS_BASE + V2M_SYS_##reg)
+
+static void print_string(const char *str)
+{
+	uint32_t flags;
+
+	while (*str) {
+		do
+			flags = raw_readl(PL011(UARTFR));
+		while (flags & PL011_UARTFR_FIFO_FULL);
+
+		raw_writel(*str++, PL011(UARTDR));
+
+		do
+			flags = raw_readl(PL011(UARTFR));
+		while (flags & PL011_UARTFR_BUSY);
+	}
+}
+
+void ns_init_system(void)
+{
+	/*
+	 * UART initialisation (38400 8N1)
+	 */
+	raw_writel(0x10,	PL011(UARTIBRD));
+	raw_writel(0x0,		PL011(UARTFBRD));
+	/* Set parameters to 8N1 and enable the FIFOs */
+	raw_writel(0x70,	PL011(UART_LCR_H));
+	/* Enable the UART, TXen and RXen */
+	raw_writel(0x301,	PL011(UARTCR));
+
+	print_string("Boot-wrapper v0.1\r\n\r\n");
+
+	/*
+	 * CLCD output site MB
+	 */
+	raw_writel(0x0,		V2M_SYS(CFGDATA));
+	/* START | WRITE | MUXFPGA | SITE_MB */
+	raw_writel((1 << 31) | (1 << 30) | (7 << 20) | (0 << 16),
+				V2M_SYS(CFGCTRL));
+}