mirror of
https://github.com/cirosantilli/linux-kernel-module-cheat.git
synced 2026-01-23 02:05:57 +01:00
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:
39
README.adoc
39
README.adoc
@@ -15470,15 +15470,23 @@ Semihosting is implemented both on some real devices and on simulators such as Q
|
|||||||
|
|
||||||
It is documented at: https://developer.arm.com/docs/100863/latest/introduction
|
It is documented at: https://developer.arm.com/docs/100863/latest/introduction
|
||||||
|
|
||||||
For example, the following code makes QEMU exit:
|
For example, all the following code make QEMU exit:
|
||||||
|
|
||||||
....
|
....
|
||||||
./run --arch arm --baremetal baremetal/arch/arm/semihost_exit.S
|
./run --arch arm --baremetal baremetal/arch/arm/semihost_exit.S
|
||||||
|
./run --arch arm --baremetal baremetal/arch/arm/no_bootloader/semihost_exit.S
|
||||||
|
./run --arch aarch64 --baremetal baremetal/arch/aarch64/semihost_exit.S
|
||||||
|
./run --arch aarch64 --baremetal baremetal/arch/aarch64/no_bootloader/semihost_exit.S
|
||||||
....
|
....
|
||||||
|
|
||||||
Source: link:baremetal/arch/arm/no_bootloader/semihost_exit.S[]
|
Sources:
|
||||||
|
|
||||||
That program program contains the code:
|
* link:baremetal/arch/arm/semihost_exit.S[]
|
||||||
|
* link:baremetal/arch/arm/no_bootloader/semihost_exit.S[]
|
||||||
|
* link:baremetal/arch/aarch64/semihost_exit.S[]
|
||||||
|
* link:baremetal/arch/aarch64/no_bootloader/semihost_exit.S[]
|
||||||
|
|
||||||
|
That `arm` program program contains the code:
|
||||||
|
|
||||||
....
|
....
|
||||||
mov r0, #0x18
|
mov r0, #0x18
|
||||||
@@ -16171,17 +16179,26 @@ See the example at: xref:arm-svc-instruction[xrefstyle=full]
|
|||||||
|
|
||||||
==== ARM multicore
|
==== ARM multicore
|
||||||
|
|
||||||
|
Examples:
|
||||||
|
|
||||||
....
|
....
|
||||||
./run --arch aarch64 --baremetal baremetal/arch/aarch64/multicore.S --cpus 2
|
./run --arch aarch64 --baremetal baremetal/arch/aarch64/no_bootloader/multicore_asm.S --cpus 2
|
||||||
./run --arch aarch64 --baremetal baremetal/arch/aarch64/multicore.S --cpus 2 --emulator gem5
|
./run --arch aarch64 --baremetal baremetal/arch/aarch64/no_bootloader/multicore_asm.S --cpus 2 --emulator gem5
|
||||||
./run --arch arm --baremetal baremetal/arch/aarch64/multicore.S --cpus 2
|
./run --arch aarch64 --baremetal baremetal/arch/aarch64/multicore.c --cpus 2
|
||||||
./run --arch arm --baremetal baremetal/arch/aarch64/multicore.S --cpus 2 --emulator gem5
|
./run --arch aarch64 --baremetal baremetal/arch/aarch64/multicore.c --cpus 2 --emulator gem5
|
||||||
|
./run --arch arm --baremetal baremetal/arch/arm/no_bootloader/multicore_asm.S --cpus 2
|
||||||
|
./run --arch arm --baremetal baremetal/arch/arm/no_bootloader/multicore_asm.S --cpus 2 --emulator gem5
|
||||||
|
# TODO not working, hangs.
|
||||||
|
# ./run --arch arm --baremetal baremetal/arch/arm/multicore.c --cpus 2
|
||||||
|
./run --arch arm --baremetal baremetal/arch/arm/multicore.c --cpus 2 --emulator gem5
|
||||||
....
|
....
|
||||||
|
|
||||||
Sources:
|
Sources:
|
||||||
|
|
||||||
* link:baremetal/arch/aarch64/multicore.S[]
|
* link:baremetal/arch/aarch64/no_bootloader/multicore_asm.S[]
|
||||||
* link:baremetal/arch/arm/multicore.S[]
|
* link:baremetal/arch/aarch64/multicore.c[]
|
||||||
|
* link:baremetal/arch/arm/no_bootloader/multicore_asm.S[]
|
||||||
|
* link:baremetal/arch/arm/multicore.c[]
|
||||||
|
|
||||||
CPU 0 of this program enters a spinlock loop: it repeatedly checks if a given memory address is 1.
|
CPU 0 of this program enters a spinlock loop: it repeatedly checks if a given memory address is 1.
|
||||||
|
|
||||||
@@ -16190,7 +16207,7 @@ So, we need CPU 1 to come to the rescue and set that memory address to 1, otherw
|
|||||||
Don't believe me? Then try:
|
Don't believe me? Then try:
|
||||||
|
|
||||||
....
|
....
|
||||||
./run --arch aarch64 --baremetal baremetal/arch/aarch64/multicore.S --cpus 1
|
./run --arch aarch64 --baremetal baremetal/arch/aarch64/multicore.c --cpus 1
|
||||||
....
|
....
|
||||||
|
|
||||||
and watch it hang forever.
|
and watch it hang forever.
|
||||||
@@ -16198,7 +16215,7 @@ and watch it hang forever.
|
|||||||
Note that if you try the same thing on gem5:
|
Note that if you try the same thing on gem5:
|
||||||
|
|
||||||
....
|
....
|
||||||
./run --arch aarch64 --baremetal baremetal/arch/aarch64/multicore.S --cpus 1 --emulator gem5
|
./run --arch aarch64 --baremetal baremetal/arch/aarch64/multicore.c --cpus 1 --emulator gem5
|
||||||
....
|
....
|
||||||
|
|
||||||
then the gem5 actually exits with <<gem5-simulate-limit-reached>> as opposed to the expected:
|
then the gem5 actually exits with <<gem5-simulate-limit-reached>> as opposed to the expected:
|
||||||
|
|||||||
45
baremetal/arch/aarch64/multicore.c
Normal file
45
baremetal/arch/aarch64/multicore.c
Normal file
@@ -0,0 +1,45 @@
|
|||||||
|
/* https://cirosantilli.com/linux-kernel-module-cheat#arm-multicore
|
||||||
|
*
|
||||||
|
* Beware: things will blow up if the stack for CPU0 grow too much and
|
||||||
|
* reaches that of CPU1. This is why it is so hard to do multithreading
|
||||||
|
* without an OS that manages paging.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <lkmc.h>
|
||||||
|
|
||||||
|
uint64_t spinlock = 0;
|
||||||
|
|
||||||
|
__asm__(
|
||||||
|
".text\n"
|
||||||
|
".global lkmc_cpu_not_0\n"
|
||||||
|
"lkmc_cpu_not_0:\n"
|
||||||
|
/* Put all CPUs except CPU1 to sleep. */
|
||||||
|
" cmp x0, 1\n"
|
||||||
|
" bne .Lsleep_forever\n"
|
||||||
|
/* Prepare the stack for CPU1. This is what we need
|
||||||
|
* this assembly function for. */
|
||||||
|
" ldr x0, =(stack_top - 0x1000)\n"
|
||||||
|
" mov sp, x0\n"
|
||||||
|
" bl main_cpu1\n"
|
||||||
|
".Lsleep_forever:\n"
|
||||||
|
" wfe\n"
|
||||||
|
" b .Lsleep_forever\n"
|
||||||
|
);
|
||||||
|
|
||||||
|
static void main_cpu1(void) {
|
||||||
|
spinlock = 1;
|
||||||
|
lkmc_arm_aarch64_dmb(sy);
|
||||||
|
lkmc_arm_aarch64_sev();
|
||||||
|
while (1) {
|
||||||
|
lkmc_arm_aarch64_wfe();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
int main(void) {
|
||||||
|
#if !LKMC_GEM5
|
||||||
|
lkmc_aarch64_psci_cpu_on(1, (uint64_t)main_cpu1, 0);
|
||||||
|
#endif
|
||||||
|
while (!spinlock) {
|
||||||
|
lkmc_arm_aarch64_wfe();
|
||||||
|
}
|
||||||
|
}
|
||||||
8
baremetal/arch/aarch64/no_bootloader/exit.S
Normal file
8
baremetal/arch/aarch64/no_bootloader/exit.S
Normal file
@@ -0,0 +1,8 @@
|
|||||||
|
/* Test _exit. */
|
||||||
|
|
||||||
|
#include <lkmc.h>
|
||||||
|
|
||||||
|
.global lkmc_start
|
||||||
|
lkmc_start:
|
||||||
|
mov x0, 0
|
||||||
|
bl _exit
|
||||||
@@ -1,11 +1,15 @@
|
|||||||
/* https://cirosantilli.com/linux-kernel-module-cheat#arm-multicore */
|
/* https://cirosantilli.com/linux-kernel-module-cheat#arm-multicore
|
||||||
|
*
|
||||||
|
* This has to be in no_bootloader
|
||||||
|
*/
|
||||||
|
|
||||||
#include <lkmc.h>
|
#include <lkmc.h>
|
||||||
|
|
||||||
LKMC_PROLOGUE
|
.global lkmc_start
|
||||||
|
lkmc_start:
|
||||||
/* Reset spinlock. */
|
/* Reset spinlock. */
|
||||||
mov x0, 0
|
mov x0, 0
|
||||||
ldr x1, =spinlock
|
ldr x1, =.Lspinlock
|
||||||
str x0, [x1]
|
str x0, [x1]
|
||||||
|
|
||||||
/* Read cpu id into x1.
|
/* Read cpu id into x1.
|
||||||
@@ -14,11 +18,11 @@ LKMC_PROLOGUE
|
|||||||
*/
|
*/
|
||||||
mrs x1, mpidr_el1
|
mrs x1, mpidr_el1
|
||||||
ands x1, x1, 3
|
ands x1, x1, 3
|
||||||
beq cpu0_only
|
beq .Lcpu0_only
|
||||||
.Lcpu1_only:
|
.Lcpu1_only:
|
||||||
/* Only CPU 1 reaches this point and sets the spinlock. */
|
/* Only CPU 1 reaches this point and sets the spinlock. */
|
||||||
mov x0, 1
|
mov x0, 1
|
||||||
ldr x1, =spinlock
|
ldr x1, =.Lspinlock
|
||||||
str x0, [x1]
|
str x0, [x1]
|
||||||
/* Ensure that CPU 0 sees the write right now.
|
/* Ensure that CPU 0 sees the write right now.
|
||||||
* Optional, but could save some useless CPU 1 loops.
|
* Optional, but could save some useless CPU 1 loops.
|
||||||
@@ -34,7 +38,7 @@ LKMC_PROLOGUE
|
|||||||
*/
|
*/
|
||||||
wfe
|
wfe
|
||||||
b .Lcpu1_sleep_forever
|
b .Lcpu1_sleep_forever
|
||||||
cpu0_only:
|
.Lcpu0_only:
|
||||||
/* Only CPU 0 reaches this point. */
|
/* Only CPU 0 reaches this point. */
|
||||||
|
|
||||||
#if !LKMC_GEM5
|
#if !LKMC_GEM5
|
||||||
@@ -61,11 +65,14 @@ cpu0_only:
|
|||||||
hvc 0
|
hvc 0
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
spinlock_start:
|
.Lspinlock_start:
|
||||||
ldr x0, spinlock
|
ldr x0, .Lspinlock
|
||||||
/* Hint CPU 0 to enter low power mode. */
|
/* Hint CPU 0 to enter low power mode. */
|
||||||
wfe
|
wfe
|
||||||
cbz x0, spinlock_start
|
cbz x0, .Lspinlock_start
|
||||||
LKMC_EPILOGUE
|
|
||||||
spinlock:
|
mov x0, 0
|
||||||
|
bl _exit
|
||||||
|
|
||||||
|
.Lspinlock:
|
||||||
.skip 8
|
.skip 8
|
||||||
@@ -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
|
.global lkmc_start
|
||||||
lkmc_start:
|
lkmc_start:
|
||||||
mov x1, 0x26
|
mov x1, 0x26
|
||||||
movk x1, 2, lsl 16
|
movk x1, 2, lsl 16
|
||||||
ldr x2, =semihost_args
|
ldr x2, =.Lsemihost_args
|
||||||
str x1, [x2, 0]
|
str x1, [x2, 0]
|
||||||
mov x0, 0
|
mov x0, 0
|
||||||
str x0, [x2, 8]
|
str x0, [x2, 8]
|
||||||
mov x1, x2
|
mov x1, x2
|
||||||
mov w0, 0x18
|
mov w0, 0x18
|
||||||
hlt 0xf000
|
hlt 0xf000
|
||||||
semihost_args:
|
.Lsemihost_args:
|
||||||
.skip 16
|
.skip 16
|
||||||
|
|||||||
@@ -1,3 +1,5 @@
|
|||||||
|
/* https://cirosantilli.com/linux-kernel-module-cheat#semihosting */
|
||||||
|
|
||||||
.global main
|
.global main
|
||||||
main:
|
main:
|
||||||
/* 0x20026 == ADP_Stopped_ApplicationExit */
|
/* 0x20026 == ADP_Stopped_ApplicationExit */
|
||||||
|
|||||||
@@ -71,7 +71,7 @@ int main(void) {
|
|||||||
printf("&after_svc %p\n", &&after_svc);
|
printf("&after_svc %p\n", &&after_svc);
|
||||||
assert(myvar == 0);
|
assert(myvar == 0);
|
||||||
/* Max 16-bits. */
|
/* Max 16-bits. */
|
||||||
lkmc_svc(0xABCD);
|
lkmc_arm_aarch64_svc(0xABCD);
|
||||||
after_svc:
|
after_svc:
|
||||||
assert(myvar == 1);
|
assert(myvar == 1);
|
||||||
return 0;
|
return 0;
|
||||||
|
|||||||
@@ -113,7 +113,7 @@ int main(void) {
|
|||||||
enable_irq();
|
enable_irq();
|
||||||
}
|
}
|
||||||
while (1) {
|
while (1) {
|
||||||
lkmc_wfi();
|
lkmc_arm_aarch64_wfi();
|
||||||
}
|
}
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|||||||
37
baremetal/arch/arm/multicore.c
Normal file
37
baremetal/arch/arm/multicore.c
Normal file
@@ -0,0 +1,37 @@
|
|||||||
|
/* https://cirosantilli.com/linux-kernel-module-cheat#arm-multicore */
|
||||||
|
|
||||||
|
#include <lkmc.h>
|
||||||
|
|
||||||
|
uint64_t spinlock = 0;
|
||||||
|
|
||||||
|
__asm__(
|
||||||
|
".syntax unified\n"
|
||||||
|
".text\n"
|
||||||
|
".global lkmc_cpu_not_0\n"
|
||||||
|
"lkmc_cpu_not_0:\n"
|
||||||
|
" cmp r0, 1\n"
|
||||||
|
" bne .Lsleep_forever\n"
|
||||||
|
" ldr sp, =(stack_top - 0x1000)\n"
|
||||||
|
" bl main_cpu1\n"
|
||||||
|
".Lsleep_forever:\n"
|
||||||
|
" wfe\n"
|
||||||
|
" b .Lsleep_forever\n"
|
||||||
|
);
|
||||||
|
|
||||||
|
static void main_cpu1(void) {
|
||||||
|
spinlock = 1;
|
||||||
|
lkmc_arm_aarch64_dmb(sy);
|
||||||
|
lkmc_arm_aarch64_sev();
|
||||||
|
while (1) {
|
||||||
|
lkmc_arm_aarch64_wfe();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
int main(void) {
|
||||||
|
#if !LKMC_GEM5
|
||||||
|
lkmc_arm_psci_cpu_on(1, (uint32_t)main_cpu1, 0);
|
||||||
|
#endif
|
||||||
|
while (!spinlock) {
|
||||||
|
lkmc_arm_aarch64_wfe();
|
||||||
|
}
|
||||||
|
}
|
||||||
@@ -2,24 +2,25 @@
|
|||||||
|
|
||||||
#include <lkmc.h>
|
#include <lkmc.h>
|
||||||
|
|
||||||
LKMC_PROLOGUE
|
.global lkmc_start
|
||||||
|
lkmc_start:
|
||||||
mov r0, 0
|
mov r0, 0
|
||||||
ldr r1, =spinlock
|
ldr r1, =.Lspinlock
|
||||||
str r0, [r1]
|
str r0, [r1]
|
||||||
/* Get CPU ID. */
|
/* Get CPU ID. */
|
||||||
mrc p15, 0, r1, c0, c0, 5
|
mrc p15, 0, r1, c0, c0, 5
|
||||||
ands r1, r1, 3
|
ands r1, r1, 3
|
||||||
beq cpu0_only
|
beq .Lcpu0_only
|
||||||
.Lcpu1_only:
|
.Lcpu1_only:
|
||||||
mov r0, 1
|
mov r0, 1
|
||||||
ldr r1, =spinlock
|
ldr r1, =.Lspinlock
|
||||||
str r0, [r1]
|
str r0, [r1]
|
||||||
dmb sy
|
dmb sy
|
||||||
sev
|
sev
|
||||||
.Lcpu1_sleep_forever:
|
.Lcpu1_sleep_forever:
|
||||||
wfe
|
wfe
|
||||||
b .Lcpu1_sleep_forever
|
b .Lcpu1_sleep_forever
|
||||||
cpu0_only:
|
.Lcpu0_only:
|
||||||
#if !LKMC_GEM5
|
#if !LKMC_GEM5
|
||||||
/* PSCI CPU_ON. */
|
/* PSCI CPU_ON. */
|
||||||
ldr r0, =0x84000003
|
ldr r0, =0x84000003
|
||||||
@@ -28,11 +29,12 @@ cpu0_only:
|
|||||||
mov r3, 0
|
mov r3, 0
|
||||||
hvc 0
|
hvc 0
|
||||||
#endif
|
#endif
|
||||||
spinlock_start:
|
.Lspinlock_start:
|
||||||
ldr r0, spinlock
|
ldr r0, .Lspinlock
|
||||||
wfe
|
wfe
|
||||||
cmp r0, 0
|
cmp r0, 0
|
||||||
beq spinlock_start
|
beq .Lspinlock_start
|
||||||
LKMC_EPILOGUE
|
mov r0, 0
|
||||||
spinlock:
|
bl _exit
|
||||||
|
.Lspinlock:
|
||||||
.skip 4
|
.skip 4
|
||||||
@@ -2,6 +2,11 @@
|
|||||||
|
|
||||||
.global lkmc_start
|
.global lkmc_start
|
||||||
lkmc_start:
|
lkmc_start:
|
||||||
|
/* Make all CPUs except CPU0 sleep by default. */
|
||||||
|
mrs x0, mpidr_el1
|
||||||
|
ands x0, x0, 3
|
||||||
|
bne lkmc_cpu_not_0
|
||||||
|
|
||||||
/* Load the vector table. */
|
/* Load the vector table. */
|
||||||
ldr x0, =lkmc_vector_table
|
ldr x0, =lkmc_vector_table
|
||||||
msr vbar_el1, x0
|
msr vbar_el1, x0
|
||||||
@@ -41,3 +46,8 @@ LKMC_WEAK(lkmc_vector_trap_handler)
|
|||||||
bl abort
|
bl abort
|
||||||
lkmc_vector_trap_handler_error_message:
|
lkmc_vector_trap_handler_error_message:
|
||||||
.asciz "error: unexpected interrupt"
|
.asciz "error: unexpected interrupt"
|
||||||
|
|
||||||
|
/* Default action for CPUs besides the first one: sleep forever. */
|
||||||
|
LKMC_WEAK(lkmc_cpu_not_0)
|
||||||
|
wfe
|
||||||
|
b lkmc_cpu_not_0
|
||||||
|
|||||||
@@ -2,6 +2,11 @@
|
|||||||
|
|
||||||
.global lkmc_start
|
.global lkmc_start
|
||||||
lkmc_start:
|
lkmc_start:
|
||||||
|
/* Make all CPUs except CPU0 sleep by default. */
|
||||||
|
mrc p15, 0, r0, c0, c0, 5
|
||||||
|
ands r0, r0, 3
|
||||||
|
bne lkmc_cpu_not_0
|
||||||
|
|
||||||
/* Prepare the stack for main, mandatory for C code. */
|
/* Prepare the stack for main, mandatory for C code. */
|
||||||
ldr sp, =stack_top
|
ldr sp, =stack_top
|
||||||
|
|
||||||
@@ -28,3 +33,8 @@ lkmc_start:
|
|||||||
|
|
||||||
/* If main returns, exit. */
|
/* If main returns, exit. */
|
||||||
bl exit
|
bl exit
|
||||||
|
|
||||||
|
/* Default action for CPUs besides the first one: sleep forever. */
|
||||||
|
LKMC_WEAK(lkmc_cpu_not_0)
|
||||||
|
wfe
|
||||||
|
b lkmc_cpu_not_0
|
||||||
|
|||||||
@@ -3,14 +3,6 @@
|
|||||||
#include <sys/stat.h>
|
#include <sys/stat.h>
|
||||||
|
|
||||||
#include <lkmc.h>
|
#include <lkmc.h>
|
||||||
#include <lkmc/m5ops.h>
|
|
||||||
|
|
||||||
void lkmc_baremetal_on_exit_callback(int status, void *arg) {
|
|
||||||
(void)arg;
|
|
||||||
if (status != 0) {
|
|
||||||
printf("lkmc_exit_status_%d\n", status);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
enum {
|
enum {
|
||||||
UART_FR_RXFE = 0x10,
|
UART_FR_RXFE = 0x10,
|
||||||
@@ -19,44 +11,18 @@ enum {
|
|||||||
#define UART_DR(baseaddr) (*(unsigned int *)(baseaddr))
|
#define UART_DR(baseaddr) (*(unsigned int *)(baseaddr))
|
||||||
#define UART_FR(baseaddr) (*(((unsigned int *)(baseaddr))+6))
|
#define UART_FR(baseaddr) (*(((unsigned int *)(baseaddr))+6))
|
||||||
|
|
||||||
|
void lkmc_baremetal_on_exit_callback(int status, void *arg) {
|
||||||
|
(void)arg;
|
||||||
|
if (status != 0) {
|
||||||
|
printf("lkmc_exit_status_%d\n", status);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
int _close(int file) {
|
int _close(int file) {
|
||||||
LKMC_UNUSED(file);
|
LKMC_UNUSED(file);
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
void _exit(int status) {
|
|
||||||
LKMC_UNUSED(status);
|
|
||||||
#if LKMC_GEM5
|
|
||||||
LKMC_M5OPS_EXIT;
|
|
||||||
#else
|
|
||||||
#if defined(__arm__)
|
|
||||||
__asm__ __volatile__ (
|
|
||||||
"mov r0, #0x18\n"
|
|
||||||
"ldr r1, =#0x20026\n"
|
|
||||||
"svc 0x00123456\n"
|
|
||||||
:
|
|
||||||
:
|
|
||||||
: "r0", "r1"
|
|
||||||
);
|
|
||||||
#elif defined(__aarch64__)
|
|
||||||
/* TODO actually use the exit value here, just for fun. */
|
|
||||||
__asm__ __volatile__ (
|
|
||||||
"mov x1, #0x26\n" \
|
|
||||||
"movk x1, #2, lsl #16\n" \
|
|
||||||
"str x1, [sp,#0]\n" \
|
|
||||||
"mov x0, #0\n" \
|
|
||||||
"str x0, [sp,#8]\n" \
|
|
||||||
"mov x1, sp\n" \
|
|
||||||
"mov w0, #0x18\n" \
|
|
||||||
"hlt 0xf000\n"
|
|
||||||
:
|
|
||||||
:
|
|
||||||
: "x0", "x1"
|
|
||||||
);
|
|
||||||
#endif
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
|
|
||||||
int _fstat(int file, struct stat *st) {
|
int _fstat(int file, struct stat *st) {
|
||||||
LKMC_UNUSED(file);
|
LKMC_UNUSED(file);
|
||||||
st->st_mode = S_IFCHR;
|
st->st_mode = S_IFCHR;
|
||||||
|
|||||||
35
baremetal/lib/syscalls_asm.S
Normal file
35
baremetal/lib/syscalls_asm.S
Normal file
@@ -0,0 +1,35 @@
|
|||||||
|
#include <lkmc.h>
|
||||||
|
|
||||||
|
/* This is implemented in assembly so that it does not use the stack,
|
||||||
|
* and thus can be called safely from programs without the bootloader.
|
||||||
|
* C signature:
|
||||||
|
*
|
||||||
|
* void _exit(int status)
|
||||||
|
*
|
||||||
|
* If only there was a GCC attribute to create such a function!
|
||||||
|
*/
|
||||||
|
.text
|
||||||
|
.global _exit
|
||||||
|
_exit:
|
||||||
|
#if LKMC_GEM5
|
||||||
|
LKMC_M5OPS_EXIT_ASM
|
||||||
|
#else
|
||||||
|
/* Use semihosting:
|
||||||
|
* https://github.com/cirosantilli/linux-kernel-module-cheat#semihosting */
|
||||||
|
#if defined(__arm__)
|
||||||
|
mov r0, #0x18
|
||||||
|
ldr r1, =#0x20026
|
||||||
|
svc 0x00123456
|
||||||
|
#elif defined(__aarch64__)
|
||||||
|
mov x1, 0x26
|
||||||
|
movk x1, 2, lsl 16
|
||||||
|
ldr x2, =.Lsemihost_args
|
||||||
|
str x1, [x2, 0]
|
||||||
|
str x0, [x2, 8]
|
||||||
|
mov x1, x2
|
||||||
|
mov w0, 0x18
|
||||||
|
hlt 0xf000
|
||||||
|
.Lsemihost_args:
|
||||||
|
.skip 16
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
@@ -45,6 +45,14 @@ Build the baremetal examples with crosstool-NG.
|
|||||||
self.env['baremetal_build_lib_dir'],
|
self.env['baremetal_build_lib_dir'],
|
||||||
syscalls_basename_noext + self.env['obj_ext']
|
syscalls_basename_noext + self.env['obj_ext']
|
||||||
)
|
)
|
||||||
|
syscalls_asm_src = os.path.join(
|
||||||
|
self.env['baremetal_source_lib_dir'],
|
||||||
|
syscalls_basename_noext + '_asm' + self.env['asm_ext']
|
||||||
|
)
|
||||||
|
syscalls_asm_obj = os.path.join(
|
||||||
|
self.env['baremetal_build_lib_dir'],
|
||||||
|
syscalls_basename_noext + '_asm' + self.env['obj_ext']
|
||||||
|
)
|
||||||
cc_flags = [
|
cc_flags = [
|
||||||
'-I', self.env['root_dir'], LF,
|
'-I', self.env['root_dir'], LF,
|
||||||
'-O{}'.format(self.env['optimization_level']), LF,
|
'-O{}'.format(self.env['optimization_level']), LF,
|
||||||
@@ -93,6 +101,7 @@ Build the baremetal examples with crosstool-NG.
|
|||||||
(bootloader_src, extra_obj_baremetal_bootloader),
|
(bootloader_src, extra_obj_baremetal_bootloader),
|
||||||
(self.env['common_c'], extra_obj_lkmc_common),
|
(self.env['common_c'], extra_obj_lkmc_common),
|
||||||
(syscalls_src, syscalls_obj),
|
(syscalls_src, syscalls_obj),
|
||||||
|
(syscalls_asm_src, syscalls_asm_obj),
|
||||||
]:
|
]:
|
||||||
self._build_one(
|
self._build_one(
|
||||||
in_path=in_path,
|
in_path=in_path,
|
||||||
@@ -123,7 +132,7 @@ Build the baremetal examples with crosstool-NG.
|
|||||||
self.env['baremetal_link_script'],
|
self.env['baremetal_link_script'],
|
||||||
self.env['common_h']
|
self.env['common_h']
|
||||||
],
|
],
|
||||||
'extra_objs': [syscalls_obj],
|
'extra_objs': [syscalls_obj, syscalls_asm_obj],
|
||||||
'extra_objs_baremetal_bootloader': [extra_obj_baremetal_bootloader],
|
'extra_objs_baremetal_bootloader': [extra_obj_baremetal_bootloader],
|
||||||
'extra_objs_lkmc_common': [extra_obj_lkmc_common],
|
'extra_objs_lkmc_common': [extra_obj_lkmc_common],
|
||||||
'in_path': in_path,
|
'in_path': in_path,
|
||||||
|
|||||||
52
lkmc.c
52
lkmc.c
@@ -68,7 +68,30 @@ void lkmc_print_newline() {
|
|||||||
printf("\n");
|
printf("\n");
|
||||||
}
|
}
|
||||||
|
|
||||||
#if defined(__aarch64__)
|
#if defined(__arm__)
|
||||||
|
|
||||||
|
void lkmc_arm_psci_cpu_on(
|
||||||
|
uint32_t target_cpu,
|
||||||
|
uint32_t entry_point_address,
|
||||||
|
uint32_t context_id
|
||||||
|
) {
|
||||||
|
register int r0 __asm__ ("r0") = 0x84000003;
|
||||||
|
register int r1 __asm__ ("r1") = target_cpu;
|
||||||
|
register int r2 __asm__ ("r2") = entry_point_address;
|
||||||
|
register int r3 __asm__ ("r3") = context_id;
|
||||||
|
__asm__ __volatile__(
|
||||||
|
"hvc 0\n"
|
||||||
|
:
|
||||||
|
: "r" (r0),
|
||||||
|
"r" (r1),
|
||||||
|
"r" (r2),
|
||||||
|
"r" (r3)
|
||||||
|
:
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
#elif defined(__aarch64__)
|
||||||
|
|
||||||
#define LKMC_SYSREG_READ_WRITE(nbits, name) \
|
#define LKMC_SYSREG_READ_WRITE(nbits, name) \
|
||||||
LKMC_CONCAT(LKMC_CONCAT(uint, nbits), _t) LKMC_CONCAT(LKMC_CONCAT(LKMC_SYSREG_SYMBOL_PREFIX, read_), name)(void) { \
|
LKMC_CONCAT(LKMC_CONCAT(uint, nbits), _t) LKMC_CONCAT(LKMC_CONCAT(LKMC_SYSREG_SYMBOL_PREFIX, read_), name)(void) { \
|
||||||
LKMC_CONCAT(LKMC_CONCAT(uint, nbits), _t) name; \
|
LKMC_CONCAT(LKMC_CONCAT(uint, nbits), _t) name; \
|
||||||
@@ -83,4 +106,31 @@ void lkmc_print_newline() {
|
|||||||
}
|
}
|
||||||
LKMC_SYSREG_OPS
|
LKMC_SYSREG_OPS
|
||||||
#undef LKMC_SYSREG_READ_WRITE
|
#undef LKMC_SYSREG_READ_WRITE
|
||||||
|
|
||||||
|
uint64_t lkmc_aarch64_cpu_id() {
|
||||||
|
/* TODO: cores beyond 4th?
|
||||||
|
* Mnemonic: Main Processor ID Register
|
||||||
|
*/
|
||||||
|
return lkmc_sysreg_read_mpidr_el1() & 3;
|
||||||
|
}
|
||||||
|
|
||||||
|
void lkmc_aarch64_psci_cpu_on(
|
||||||
|
uint64_t target_cpu,
|
||||||
|
uint64_t entry_point_address,
|
||||||
|
uint64_t context_id
|
||||||
|
) {
|
||||||
|
register int w0 __asm__ ("w0") = 0xc4000003;
|
||||||
|
register int x1 __asm__ ("x1") = target_cpu;
|
||||||
|
register int x2 __asm__ ("x2") = entry_point_address;
|
||||||
|
register int x3 __asm__ ("x3") = context_id;
|
||||||
|
__asm__ __volatile__(
|
||||||
|
"hvc 0\n"
|
||||||
|
:
|
||||||
|
: "r" (w0),
|
||||||
|
"r" (x1),
|
||||||
|
"r" (x2),
|
||||||
|
"r" (x3)
|
||||||
|
:
|
||||||
|
);
|
||||||
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|||||||
7
lkmc.h
7
lkmc.h
@@ -1,4 +1,7 @@
|
|||||||
/* https://cirosantilli.com/linux-kernel-module-cheat#lkmc-c */
|
/* https://cirosantilli.com/linux-kernel-module-cheat#lkmc-c
|
||||||
|
*
|
||||||
|
* This toplevel header includes all the lkmc/ *.h headers.
|
||||||
|
*/
|
||||||
|
|
||||||
#ifndef LKMC_H
|
#ifndef LKMC_H
|
||||||
#define LKMC_H
|
#define LKMC_H
|
||||||
@@ -69,4 +72,6 @@ void lkmc_assert_memcmp(const void *s1, const void *s2, size_t n, uint32_t line)
|
|||||||
#error
|
#error
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#include <lkmc/m5ops.h>
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|||||||
@@ -1,6 +1,8 @@
|
|||||||
#ifndef LKMC_AARCH64_H
|
#ifndef LKMC_AARCH64_H
|
||||||
#define LKMC_AARCH64_H
|
#define LKMC_AARCH64_H
|
||||||
|
|
||||||
|
#include <lkmc/arm_aarch64.h>
|
||||||
|
|
||||||
#define LKMC_ASSERT_EQ(reg, const) \
|
#define LKMC_ASSERT_EQ(reg, const) \
|
||||||
mov x0, reg; \
|
mov x0, reg; \
|
||||||
ldr x1, const; \
|
ldr x1, const; \
|
||||||
@@ -292,10 +294,7 @@ typedef struct {
|
|||||||
} LkmcVectorExceptionFrame;
|
} LkmcVectorExceptionFrame;
|
||||||
|
|
||||||
void lkmc_vector_trap_handler(LkmcVectorExceptionFrame *exception);
|
void lkmc_vector_trap_handler(LkmcVectorExceptionFrame *exception);
|
||||||
|
void lkmc_cpu_not_0(uint64_t cpuid);
|
||||||
/* Misc assembly instructions. */
|
|
||||||
#define lkmc_svc(immediate) __asm__ __volatile__("svc " #immediate : : : )
|
|
||||||
#define lkmc_wfi() __asm__ __volatile__ ("wfi" : : : "memory")
|
|
||||||
|
|
||||||
/* Sysreg read and write functions, e.g.:
|
/* Sysreg read and write functions, e.g.:
|
||||||
*
|
*
|
||||||
@@ -310,16 +309,26 @@ void lkmc_vector_trap_handler(LkmcVectorExceptionFrame *exception);
|
|||||||
void LKMC_CONCAT(LKMC_CONCAT(LKMC_SYSREG_SYMBOL_PREFIX, print_), name)(void);
|
void LKMC_CONCAT(LKMC_CONCAT(LKMC_SYSREG_SYMBOL_PREFIX, print_), name)(void);
|
||||||
#define LKMC_SYSREG_OPS \
|
#define LKMC_SYSREG_OPS \
|
||||||
LKMC_SYSREG_READ_WRITE(32, cntv_ctl_el0) \
|
LKMC_SYSREG_READ_WRITE(32, cntv_ctl_el0) \
|
||||||
LKMC_SYSREG_READ_WRITE(64, daif) \
|
|
||||||
LKMC_SYSREG_READ_WRITE(32, spsel) \
|
|
||||||
LKMC_SYSREG_READ_WRITE(64, cntfrq_el0) \
|
LKMC_SYSREG_READ_WRITE(64, cntfrq_el0) \
|
||||||
LKMC_SYSREG_READ_WRITE(64, cntv_cval_el0) \
|
LKMC_SYSREG_READ_WRITE(64, cntv_cval_el0) \
|
||||||
LKMC_SYSREG_READ_WRITE(64, cntv_tval_el0) \
|
LKMC_SYSREG_READ_WRITE(64, cntv_tval_el0) \
|
||||||
LKMC_SYSREG_READ_WRITE(64, cntvct_el0) \
|
LKMC_SYSREG_READ_WRITE(64, cntvct_el0) \
|
||||||
|
LKMC_SYSREG_READ_WRITE(64, daif) \
|
||||||
|
LKMC_SYSREG_READ_WRITE(64, mpidr_el1) \
|
||||||
LKMC_SYSREG_READ_WRITE(64, sp_el1) \
|
LKMC_SYSREG_READ_WRITE(64, sp_el1) \
|
||||||
|
LKMC_SYSREG_READ_WRITE(32, spsel) \
|
||||||
LKMC_SYSREG_READ_WRITE(64, vbar_el1)
|
LKMC_SYSREG_READ_WRITE(64, vbar_el1)
|
||||||
LKMC_SYSREG_OPS
|
LKMC_SYSREG_OPS
|
||||||
#undef LKMC_SYSREG_READ_WRITE
|
#undef LKMC_SYSREG_READ_WRITE
|
||||||
|
|
||||||
|
/* Determine what is the ID of the currently running CPU. */
|
||||||
|
uint64_t lkmc_aarch64_cpu_id();
|
||||||
|
|
||||||
|
void lkmc_aarch64_psci_cpu_on(
|
||||||
|
uint64_t target_cpu,
|
||||||
|
uint64_t entry_point_address,
|
||||||
|
uint64_t context_id
|
||||||
|
);
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
#endif
|
#endif
|
||||||
|
|||||||
12
lkmc/arm.h
12
lkmc/arm.h
@@ -1,8 +1,20 @@
|
|||||||
#ifndef LKMC_ARM_H
|
#ifndef LKMC_ARM_H
|
||||||
#define LKMC_ARM_H
|
#define LKMC_ARM_H
|
||||||
|
|
||||||
|
#include <lkmc/arm_aarch64.h>
|
||||||
|
|
||||||
#if defined(__ASSEMBLER__)
|
#if defined(__ASSEMBLER__)
|
||||||
|
|
||||||
.syntax unified
|
.syntax unified
|
||||||
|
|
||||||
|
#else
|
||||||
|
|
||||||
|
void lkmc_arm_psci_cpu_on(
|
||||||
|
uint32_t target_cpu,
|
||||||
|
uint32_t entry_point_address,
|
||||||
|
uint32_t context_id
|
||||||
|
);
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#define LKMC_ASSERT_EQ(reg, const) \
|
#define LKMC_ASSERT_EQ(reg, const) \
|
||||||
|
|||||||
12
lkmc/arm_aarch64.h
Normal file
12
lkmc/arm_aarch64.h
Normal file
@@ -0,0 +1,12 @@
|
|||||||
|
#ifndef LKMC_ARM_AARCH64_H
|
||||||
|
#define LKMC_ARM_AARCH64_H
|
||||||
|
|
||||||
|
/* Stuff that is common between arm and aarch64. */
|
||||||
|
#define lkmc_arm_aarch64_wfe() __asm__ __volatile__ ("wfe" : : : )
|
||||||
|
#define lkmc_arm_aarch64_dmb(type) __asm__ __volatile__ ("dmb " #type : : : "memory")
|
||||||
|
#define lkmc_arm_aarch64_sev(immediate) __asm__ __volatile__("sev" : : : )
|
||||||
|
#define lkmc_arm_aarch64_hvc(immediate) __asm__ __volatile__("hvc " #immediate : : : )
|
||||||
|
#define lkmc_arm_aarch64_svc(immediate) __asm__ __volatile__("svc " #immediate : : : )
|
||||||
|
#define lkmc_arm_aarch64_wfi() __asm__ __volatile__ ("wfi" : : : )
|
||||||
|
|
||||||
|
#endif
|
||||||
@@ -284,11 +284,17 @@ path_properties_tuples = (
|
|||||||
'arm': (
|
'arm': (
|
||||||
{'allowed_archs': {'arm'}},
|
{'allowed_archs': {'arm'}},
|
||||||
{
|
{
|
||||||
'multicore.S': {'test_run_args': {'cpus': 2}},
|
'multicore.c': {
|
||||||
|
# It is hard to get visibility into what is going on
|
||||||
|
# in that one due to the multicore business.
|
||||||
|
'skip_run_unclassified': True,
|
||||||
|
'test_run_args': {'cpus': 2}
|
||||||
|
},
|
||||||
'no_bootloader': (
|
'no_bootloader': (
|
||||||
{'extra_objs_disable_baremetal_bootloader': True},
|
{'extra_objs_disable_baremetal_bootloader': True},
|
||||||
{
|
{
|
||||||
'gem5_exit.S': {'requires_m5ops': True},
|
'gem5_exit.S': {'requires_m5ops': True},
|
||||||
|
'multicore_asm.S': {'test_run_args': {'cpus': 2}},
|
||||||
'semihost_exit.S': {'requires_semihosting': True},
|
'semihost_exit.S': {'requires_semihosting': True},
|
||||||
}
|
}
|
||||||
),
|
),
|
||||||
@@ -300,11 +306,12 @@ path_properties_tuples = (
|
|||||||
'aarch64': (
|
'aarch64': (
|
||||||
{'allowed_archs': {'aarch64'}},
|
{'allowed_archs': {'aarch64'}},
|
||||||
{
|
{
|
||||||
'multicore.S': {'test_run_args': {'cpus': 2}},
|
'multicore.c': {'test_run_args': {'cpus': 2}},
|
||||||
'no_bootloader': (
|
'no_bootloader': (
|
||||||
{'extra_objs_disable_baremetal_bootloader': True},
|
{'extra_objs_disable_baremetal_bootloader': True},
|
||||||
{
|
{
|
||||||
'gem5_exit.S': {'requires_m5ops': True},
|
'gem5_exit.S': {'requires_m5ops': True},
|
||||||
|
'multicore_asm.S': {'test_run_args': {'cpus': 2}},
|
||||||
'semihost_exit.S': {'requires_semihosting': True},
|
'semihost_exit.S': {'requires_semihosting': True},
|
||||||
'wfe_loop.S': {'more_than_1s': True},
|
'wfe_loop.S': {'more_than_1s': True},
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user