blob: a528a550a29b849f3bd1cb9c3993534616e0eb46 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
|
/*
* platform.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 init_platform(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.2\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));
}
|
