xref: /rk3399_ARM-atf/plat/intel/soc/common/soc/socfpga_handoff.c (revision 97d48be01658adb7859c02a36cf34706483666a2)
1 /*
2  * Copyright (c) 2019-2023, Intel Corporation. All rights reserved.
3  * Copyright (c) 2024, Altera Corporation. All rights reserved.
4  *
5  * SPDX-License-Identifier: BSD-3-Clause
6  */
7 
8 #include <errno.h>
9 #include <string.h>
10 
11 #include "socfpga_handoff.h"
12 
13 #define SWAP_UINT32(x) (((x) >> 24) | (((x) & 0x00FF0000) >> 8) |	\
14 				(((x) & 0x0000FF00) << 8) | ((x) << 24))
15 
socfpga_get_handoff(handoff * reverse_hoff_ptr)16 int socfpga_get_handoff(handoff *reverse_hoff_ptr)
17 {
18 	int i;
19 	int j;
20 	uint32_t *buffer;
21 	uint32_t *handoff_ptr = (uint32_t *) PLAT_HANDOFF_OFFSET;
22 	uint32_t *reverse_hoff_ptr_dst = (uint32_t *) reverse_hoff_ptr;
23 
24 	if (sizeof(*handoff_ptr) > sizeof(handoff)) {
25 		return -EOVERFLOW;
26 	}
27 
28 	for (j = 0; j < sizeof(handoff) / 4; j++) {
29 		memcpy_s((void *) (reverse_hoff_ptr_dst + j), 1,
30 			(void *) (handoff_ptr + j), 1);
31 	}
32 
33 	buffer = (uint32_t *)reverse_hoff_ptr_dst;
34 
35 	/* convert big endian to little endian */
36 	for (i = 0; i < sizeof(handoff) / 4; i++)
37 		buffer[i] = SWAP_UINT32(buffer[i]);
38 
39 	if (reverse_hoff_ptr->header_magic != HANDOFF_MAGIC_HEADER) {
40 		return -1;
41 	}
42 	if (reverse_hoff_ptr->pinmux_sel_magic != HANDOFF_MAGIC_PINMUX_SEL) {
43 		return -1;
44 	}
45 	if (reverse_hoff_ptr->pinmux_io_magic != HANDOFF_MAGIC_IOCTLR) {
46 		return -1;
47 	}
48 	if (reverse_hoff_ptr->pinmux_fpga_magic != HANDOFF_MAGIC_FPGA) {
49 		return -1;
50 	}
51 	if (reverse_hoff_ptr->pinmux_delay_magic != HANDOFF_MAGIC_IODELAY) {
52 		return -1;
53 	}
54 	if (reverse_hoff_ptr->clock_magic != HANDOFF_MAGIC_CLOCK) {
55 		return -1;
56 	}
57 
58 #if PLATFORM_MODEL == PLAT_SOCFPGA_AGILEX5
59 	if (reverse_hoff_ptr->peripheral_pwr_gate_magic != HANDOFF_MAGIC_PERIPHERAL) {
60 		return -1;
61 	}
62 
63 	if (reverse_hoff_ptr->ddr_magic != HANDOFF_MAGIC_DDR) {
64 		return -1;
65 	}
66 #endif
67 
68 	return 0;
69 }
70