blob: 2c2e298b2305f4428d7fd5da51d13f1de80eb261 (
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
70
71
72
73
74
75
|
/*
* Copyright : (C) 2022 Phytium Information Technology, Inc.
* All Rights Reserved.
*
* This program is OPEN SOURCE software: you can redistribute it and/or modify it
* under the terms of the Phytium Public License as published by the Phytium Technology Co.,Ltd,
* either version 1.0 of the License, or (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,but WITHOUT ANY WARRANTY;
* without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
* See the Phytium Public License for more details.
*
*
* FilePath: psci.c
* Date: 2022-02-10 14:53:41
* LastEditTime: 2022-02-17 17:30:35
* Description: This files is for
*
* Modify History:
* Ver Who Date Changes
* ----- ------ -------- --------------------------------------
*/
#include "fpsci.h"
#include "fsmc.h"
#include "fcpu_info.h"
#include "ferror_code.h"
#include "fparameters.h"
#include "ftypes.h"
#define PSCI_CPUON_NUM 0x84000003
#define PSCI_RESET_NUM 0x84000009
/**
* @name: FPsci_CpuOn
* @msg: Power up a core
* @in param cpu_id_mask: cpu id mask
* @in param bootaddr: a 32-bit entry point physical address (or IPA).
* @return FError
*/
FError PsciCpuOn(s32 cpu_id_mask, uintptr bootaddr)
{
FError ret ;
u64 cluster = 0;
FSmc_Data_t input = {0};
FSmc_Data_t output = {0};
input.function_identifier = PSCI_CPUON_NUM;
ret = GetCpuAffinityByMask(cpu_id_mask, &cluster);
if (ret != ERR_SUCCESS)
{
return ret;
}
input.a1 = cluster;
input.a2 = (u32)(bootaddr & 0xFFFFFFFF);
FSmcCall(&input, &output);
__asm__ volatile("NOP");
return ERR_SUCCESS;
}
void PsciCpuReset(void)
{
FSmc_Data_t input = {0};
FSmc_Data_t output = {0};
input.function_identifier = PSCI_RESET_NUM;
FSmcCall(&input, &output);
__asm__ volatile("NOP");
while (1)
;
}
|
