mirror of
https://github.com/projectacrn/acrn-hypervisor.git
synced 2025-11-13 09:02:53 +00:00
b26ef37519
Tracked-On: #8805 Signed-off-by: Fei Li <fei1.li@intel.com> Acked-by: Wang, Yu1 <yu1.wang@intel.com>
131 lines
2.6 KiB
C
131 lines
2.6 KiB
C
/*
|
|
* Copyright (C) 2025 Intel Corporation.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
#include <per_cpu.h>
|
|
#include <cpu.h>
|
|
#include <delay.h>
|
|
#include <logmsg.h>
|
|
#include <bits.h>
|
|
#include <schedule.h>
|
|
|
|
static volatile uint64_t pcpu_active_bitmap = 0UL;
|
|
|
|
/*
|
|
* @post return <= MAX_PCPU_NUM
|
|
*/
|
|
uint16_t get_pcpu_nums(void)
|
|
{
|
|
return arch_get_pcpu_num();
|
|
}
|
|
|
|
bool is_pcpu_active(uint16_t pcpu_id)
|
|
{
|
|
return bitmap_test(pcpu_id, &pcpu_active_bitmap);
|
|
}
|
|
|
|
void set_pcpu_active(uint16_t pcpu_id)
|
|
{
|
|
bitmap_set(pcpu_id, &pcpu_active_bitmap);
|
|
}
|
|
|
|
void clear_pcpu_active(uint16_t pcpu_id)
|
|
{
|
|
|
|
bitmap_clear(pcpu_id, &pcpu_active_bitmap);
|
|
}
|
|
|
|
bool check_pcpus_active(uint64_t mask)
|
|
{
|
|
return ((pcpu_active_bitmap & mask) == mask);
|
|
}
|
|
|
|
bool check_pcpus_inactive(uint64_t mask)
|
|
{
|
|
return ((pcpu_active_bitmap & mask) != 0UL);
|
|
}
|
|
|
|
uint64_t get_active_pcpu_bitmap(void)
|
|
{
|
|
return pcpu_active_bitmap;
|
|
}
|
|
|
|
void pcpu_set_current_state(uint16_t pcpu_id, enum pcpu_boot_state state)
|
|
{
|
|
/* Check if state is initializing */
|
|
if (state == PCPU_STATE_INITIALIZING) {
|
|
|
|
/* Save this CPU's logical ID to arch specific per-cpu reg */
|
|
set_current_pcpu_id(pcpu_id);
|
|
}
|
|
|
|
/* Set state for the specified CPU */
|
|
per_cpu(boot_state, pcpu_id) = state;
|
|
}
|
|
|
|
/**
|
|
* @brief Start all cpus if the bit is set in mask except itself
|
|
*
|
|
* @param[in] mask bits mask of cpus which should be started
|
|
*
|
|
* @return true if all cpus set in mask are started
|
|
* @return false if there are any cpus set in mask aren't started
|
|
*/
|
|
bool start_pcpus(uint64_t mask)
|
|
{
|
|
uint16_t i;
|
|
uint16_t pcpu_id = get_pcpu_id();
|
|
uint64_t expected_start_mask = mask;
|
|
uint32_t timeout;
|
|
|
|
i = ffs64(expected_start_mask);
|
|
while (i != INVALID_BIT_INDEX) {
|
|
bitmap_clear_non_atomic(i, &expected_start_mask);
|
|
|
|
if (pcpu_id == i) {
|
|
continue; /* Avoid start itself */
|
|
}
|
|
|
|
arch_start_pcpu(i);
|
|
|
|
/* Wait until the pcpu with pcpu_id is running and set
|
|
* the active bitmap or configured time-out has expired
|
|
*/
|
|
timeout = CPU_UP_TIMEOUT * 1000U;
|
|
while (!is_pcpu_active(i) && (timeout != 0U)) {
|
|
/* Delay 10us */
|
|
udelay(10U);
|
|
|
|
/* Decrement timeout value */
|
|
timeout -= 10U;
|
|
}
|
|
|
|
/* Check to see if expected CPU is actually up */
|
|
if (!is_pcpu_active(i)) {
|
|
pr_fatal("Secondary CPU%hu failed to come up", i);
|
|
pcpu_set_current_state(i, PCPU_STATE_DEAD);
|
|
}
|
|
|
|
i = ffs64(expected_start_mask);
|
|
}
|
|
|
|
return check_pcpus_active(mask);
|
|
}
|
|
|
|
void cpu_dead(void)
|
|
{
|
|
uint16_t pcpu_id = get_pcpu_id();
|
|
|
|
deinit_sched(pcpu_id);
|
|
arch_cpu_dead();
|
|
}
|
|
|
|
void print_hv_banner(void)
|
|
{
|
|
const char *boot_msg = "ACRN Hypervisor\n\r";
|
|
|
|
/* Print the boot message */
|
|
printf(boot_msg);
|
|
}
|