1 /*
2  * Copyright (C) 2018 Marvell International Ltd.
3  *
4  * SPDX-License-Identifier:     BSD-3-Clause
5  * https://spdx.org/licenses
6  */
7 
8 #include <assert.h>
9 
10 #include <arch_helpers.h>
11 #include <lib/psci/psci.h>
12 
13 #include <marvell_pm.h>
14 
15 /* Standard ARM platforms are expected to export plat_arm_psci_pm_ops */
16 extern const plat_psci_ops_t plat_arm_psci_pm_ops;
17 
18 /*****************************************************************************
19  * Private function to program the mailbox for a cpu before it is released
20  * from reset. This function assumes that the mail box base is within
21  * the MARVELL_SHARED_RAM region
22  *****************************************************************************
23  */
marvell_program_mailbox(uintptr_t address)24 void marvell_program_mailbox(uintptr_t address)
25 {
26 	uintptr_t *mailbox = (void *)PLAT_MARVELL_MAILBOX_BASE;
27 
28 	/*
29 	 * Ensure that the PLAT_MARVELL_MAILBOX_BASE is within
30 	 * MARVELL_SHARED_RAM region.
31 	 */
32 	assert((PLAT_MARVELL_MAILBOX_BASE >= MARVELL_SHARED_RAM_BASE) &&
33 	       ((PLAT_MARVELL_MAILBOX_BASE + sizeof(*mailbox)) <=
34 	       (MARVELL_SHARED_RAM_BASE + MARVELL_SHARED_RAM_SIZE)));
35 
36 	mailbox[MBOX_IDX_MAGIC] = MVEBU_MAILBOX_MAGIC_NUM;
37 	mailbox[MBOX_IDX_SEC_ADDR] = address;
38 
39 	/* Flush data cache if the mail box shared RAM is cached */
40 #if PLAT_MARVELL_SHARED_RAM_CACHED
41 	flush_dcache_range((uintptr_t)PLAT_MARVELL_MAILBOX_BASE +
42 			   8 * MBOX_IDX_MAGIC,
43 			   2 * sizeof(uint64_t));
44 #endif
45 }
46 
47 /*****************************************************************************
48  * The ARM Standard platform definition of platform porting API
49  * `plat_setup_psci_ops`.
50  *****************************************************************************
51  */
plat_setup_psci_ops(uintptr_t sec_entrypoint,const plat_psci_ops_t ** psci_ops)52 int plat_setup_psci_ops(uintptr_t sec_entrypoint,
53 			const plat_psci_ops_t **psci_ops)
54 {
55 	*psci_ops = &plat_arm_psci_pm_ops;
56 
57 	/* Setup mailbox with entry point. */
58 	marvell_program_mailbox(sec_entrypoint);
59 	return 0;
60 }
61