xref: /optee_os/core/arch/arm/plat-d02/main.c (revision f7859906faa00a29398cf4a9f5f703dbf310fb63)
1 // SPDX-License-Identifier: BSD-2-Clause
2 /*
3  * Copyright (c) 2015, Linaro Limited
4  */
5 
6 #include <console.h>
7 #include <drivers/hi16xx_uart.h>
8 #include <kernel/generic_boot.h>
9 #include <kernel/panic.h>
10 #include <kernel/pm_stubs.h>
11 #include <mm/tee_pager.h>
12 #include <mm/core_memprot.h>
13 #include <platform_config.h>
14 #include <stdint.h>
15 #include <tee/entry_std.h>
16 #include <tee/entry_fast.h>
17 
18 static void main_fiq(void);
19 
20 static const struct thread_handlers handlers = {
21 	.std_smc = tee_entry_std,
22 	.fast_smc = tee_entry_fast,
23 	.nintr = main_fiq,
24 	.cpu_on = cpu_on_handler,
25 	.cpu_off = pm_do_nothing,
26 	.cpu_suspend = pm_do_nothing,
27 	.cpu_resume = pm_do_nothing,
28 	.system_off = pm_do_nothing,
29 	.system_reset = pm_do_nothing,
30 };
31 
32 static struct hi16xx_uart_data console_data;
33 
34 register_phys_mem_pgdir(MEM_AREA_IO_NSEC, CONSOLE_UART_BASE,
35 			HI16XX_UART_REG_SIZE);
36 
37 const struct thread_handlers *generic_boot_get_handlers(void)
38 {
39 	return &handlers;
40 }
41 
42 static void main_fiq(void)
43 {
44 	panic();
45 }
46 
47 void console_init(void)
48 {
49 	hi16xx_uart_init(&console_data, CONSOLE_UART_BASE,
50 			 CONSOLE_UART_CLK_IN_HZ, CONSOLE_BAUDRATE);
51 	register_serial_console(&console_data.chip);
52 }
53