76 lines
1.9 KiB
C
76 lines
1.9 KiB
C
/*
|
||
* 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)
|
||
;
|
||
}
|