baremetal aarch64: create C version of multicore.S as well

Attempted to do the same for arm, but it failed.
This commit is contained in:
Ciro Santilli 六四事件 法轮功
2019-08-21 00:00:00 +00:00
parent 6f88fa17bc
commit f28191a735
21 changed files with 336 additions and 89 deletions

View File

@@ -0,0 +1,8 @@
/* Test _exit. */
#include <lkmc.h>
.global lkmc_start
lkmc_start:
mov x0, 0
bl _exit

View File

@@ -0,0 +1,78 @@
/* https://cirosantilli.com/linux-kernel-module-cheat#arm-multicore
*
* This has to be in no_bootloader
*/
#include <lkmc.h>
.global lkmc_start
lkmc_start:
/* Reset spinlock. */
mov x0, 0
ldr x1, =.Lspinlock
str x0, [x1]
/* Read cpu id into x1.
* TODO: cores beyond 4th?
* Mnemonic: Main Processor ID Register
*/
mrs x1, mpidr_el1
ands x1, x1, 3
beq .Lcpu0_only
.Lcpu1_only:
/* Only CPU 1 reaches this point and sets the spinlock. */
mov x0, 1
ldr x1, =.Lspinlock
str x0, [x1]
/* Ensure that CPU 0 sees the write right now.
* Optional, but could save some useless CPU 1 loops.
*/
dmb sy
/* Wake up CPU 0 if it is sleeping on wfe.
* Optional, but could save power on a real system.
*/
sev
.Lcpu1_sleep_forever:
/* Hint CPU 1 to enter low power mode.
* Optional, but could save power on a real system.
*/
wfe
b .Lcpu1_sleep_forever
.Lcpu0_only:
/* Only CPU 0 reaches this point. */
#if !LKMC_GEM5
/* Wake up CPU 1 from initial sleep!
* See:https://cirosantilli.com/linux-kernel-module-cheat#arm-psci
*/
/* PCSI function identifier: CPU_ON. */
ldr w0, =0xc4000003
/* Argument 1: target_cpu */
mov x1, 1
/* Argument 2: entry_point_address */
ldr x2, =.Lcpu1_only
/* Argument 3: context_id */
mov x3, 0
/* Unused hvc args: the Linux kernel zeroes them,
* but I don't think it is required.
*/
#if 0
mov x4, 0
mov x5, 0
mov x6, 0
mov x7, 0
#endif
hvc 0
#endif
.Lspinlock_start:
ldr x0, .Lspinlock
/* Hint CPU 0 to enter low power mode. */
wfe
cbz x0, .Lspinlock_start
mov x0, 0
bl _exit
.Lspinlock:
.skip 8

View File

@@ -1,15 +1,19 @@
/* https://cirosantilli.com/linux-kernel-module-cheat#semihosting */
/* https://cirosantilli.com/linux-kernel-module-cheat#semihosting
*
* Since our stack pointer is not setup, we justa allocate a memory
* region to contain the semihosting arguments, which must be in memory.
*/
.global lkmc_start
lkmc_start:
mov x1, 0x26
movk x1, 2, lsl 16
ldr x2, =semihost_args
ldr x2, =.Lsemihost_args
str x1, [x2, 0]
mov x0, 0
str x0, [x2, 8]
mov x1, x2
mov w0, 0x18
hlt 0xf000
semihost_args:
.Lsemihost_args:
.skip 16