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)
|
|||
|
|
;
|
|||
|
|
}
|