1 /*
2 * Copyright (c) 2013-2019 Huawei Technologies Co., Ltd. All rights reserved.
3 * Copyright (c) 2020-2021 Huawei Device Co., Ltd. All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without modification,
6 * are permitted provided that the following conditions are met:
7 *
8 * 1. Redistributions of source code must retain the above copyright notice, this list of
9 * conditions and the following disclaimer.
10 *
11 * 2. Redistributions in binary form must reproduce the above copyright notice, this list
12 * of conditions and the following disclaimer in the documentation and/or other materials
13 * provided with the distribution.
14 *
15 * 3. Neither the name of the copyright holder nor the names of its contributors may be used
16 * to endorse or promote products derived from this software without specific prior written
17 * permission.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
20 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
21 * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
23 * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
24 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
25 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
26 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
27 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
28 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
29 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 */
31
32 #include "smp.h"
33 #include "arch_config.h"
34 #include "los_base.h"
35 #include "los_hw.h"
36 #include "los_atomic.h"
37 #include "los_arch_mmu.h"
38 #include "gic_common.h"
39 #include "los_task_pri.h"
40
41 #ifdef LOSCFG_KERNEL_SMP
42
43 extern VOID reset_vector(VOID);
44
45 struct OsCpuInit {
46 ArchCpuStartFunc cpuStart;
47 VOID *arg;
48 Atomic initFlag;
49 };
50
51 STATIC struct OsCpuInit g_cpuInit[CORE_NUM - 1] = {0};
52
HalArchCpuOn(UINT32 cpuNum,ArchCpuStartFunc func,struct SmpOps * ops,VOID * arg)53 VOID HalArchCpuOn(UINT32 cpuNum, ArchCpuStartFunc func, struct SmpOps *ops, VOID *arg)
54 {
55 struct OsCpuInit *cpuInit = &g_cpuInit[cpuNum - 1];
56 UINTPTR startEntry = (UINTPTR)&reset_vector - KERNEL_VMM_BASE + SYS_MEM_BASE;
57 INT32 ret;
58
59 cpuInit->cpuStart = func;
60 cpuInit->arg = arg;
61 cpuInit->initFlag = 0;
62
63 DCacheFlushRange((UINTPTR)cpuInit, (UINTPTR)cpuInit + sizeof(struct OsCpuInit));
64
65 LOS_ASSERT(ops != NULL);
66
67
68 ret = ops->SmpCpuOn(cpuNum, startEntry);
69 if (ret < 0) {
70 PRINT_ERR("cpu start failed, cpu num: %u, ret: %d\n", cpuNum, ret);
71 return;
72 }
73
74 while (!LOS_AtomicRead(&cpuInit->initFlag)) {
75 WFE;
76 }
77 }
78
HalSecondaryCpuStart(VOID)79 VOID HalSecondaryCpuStart(VOID)
80 {
81 UINT32 cpuid = ArchCurrCpuid();
82 struct OsCpuInit *cpuInit = &g_cpuInit[cpuid - 1];
83
84 OsCurrTaskSet(OsGetMainTask());
85
86 LOS_AtomicSet(&cpuInit->initFlag, 1);
87 SEV;
88
89 #ifdef LOSCFG_KERNEL_MMU
90 OsArchMmuInitPerCPU();
91 #endif
92
93 /* store each core's hwid */
94 CPU_MAP_SET(cpuid, OsHwIDGet());
95 HalIrqInitPercpu();
96
97 cpuInit->cpuStart(cpuInit->arg);
98
99 while (1) {
100 WFI;
101 }
102 }
103 #endif
104
105