Starting Point
This commit is contained in:
1
arch/bsp/.gitignore
vendored
Normal file
1
arch/bsp/.gitignore
vendored
Normal file
@@ -0,0 +1 @@
|
||||
# empty gitignore
|
||||
42
arch/bsp/yellow_led.c
Normal file
42
arch/bsp/yellow_led.c
Normal file
@@ -0,0 +1,42 @@
|
||||
#include <arch/bsp/yellow_led.h>
|
||||
#include <stddef.h>
|
||||
|
||||
static constexpr unsigned int GPIO_BASE = 0x7E200000 - 0x3F000000;
|
||||
static constexpr unsigned int YELLOW_LED = 7u;
|
||||
static constexpr unsigned int GPF_BITS = 3u;
|
||||
static constexpr unsigned int GPF_MASK = 0b111u;
|
||||
static constexpr unsigned int YELLOW_LED_GPF_SHIFT = YELLOW_LED * GPF_BITS;
|
||||
|
||||
enum gpio_func {
|
||||
gpio_input = 0x0,
|
||||
gpio_output = 0x1,
|
||||
};
|
||||
|
||||
struct gpio {
|
||||
unsigned int func[6];
|
||||
unsigned int unused0;
|
||||
unsigned int set[2];
|
||||
unsigned int unused1;
|
||||
unsigned int clr[2];
|
||||
};
|
||||
static_assert(offsetof(struct gpio, func) == 0x00);
|
||||
static_assert(offsetof(struct gpio, set) == 0x1C);
|
||||
static_assert(offsetof(struct gpio, clr) == 0x28);
|
||||
|
||||
static volatile struct gpio *const gpio_port = (struct gpio *)GPIO_BASE;
|
||||
|
||||
void init_yellow(void)
|
||||
{
|
||||
gpio_port->func[0] = (gpio_port->func[0] & ~(GPF_MASK << YELLOW_LED_GPF_SHIFT)) |
|
||||
(gpio_output << YELLOW_LED_GPF_SHIFT);
|
||||
}
|
||||
|
||||
void yellow_on(void)
|
||||
{
|
||||
gpio_port->set[0] = 1 << YELLOW_LED;
|
||||
}
|
||||
|
||||
void yellow_off(void)
|
||||
{
|
||||
gpio_port->clr[0] = 1 << YELLOW_LED;
|
||||
}
|
||||
1
arch/cpu/.gitignore
vendored
Normal file
1
arch/cpu/.gitignore
vendored
Normal file
@@ -0,0 +1 @@
|
||||
# empty gitignore
|
||||
70
arch/cpu/entry.S
Normal file
70
arch/cpu/entry.S
Normal file
@@ -0,0 +1,70 @@
|
||||
|
||||
.section .init
|
||||
|
||||
.global _start
|
||||
_start:
|
||||
/* Erkennen ob Hypervisor Mode aktiv */
|
||||
mrs r0, cpsr
|
||||
and r0, r0, #0x1F
|
||||
mov r1, #0x1A //Modebits = 0x1A = Hypervisor Mode
|
||||
cmp r0, r1 //Vergleichen und Statusbits setzen für bedingte Sprünge
|
||||
|
||||
/* Wenn Hypemode erkannt: abschalten (sprung nach _exitHyper)
|
||||
* wenn nicht erkannt: dann weitermachen (weiterlaufen nach _bsprak)
|
||||
*/
|
||||
beq _exitHyper
|
||||
|
||||
/* Qemu startet immer alle 4 Kerne
|
||||
* Wir lassen alle anderen Kerne endless loopen
|
||||
*/
|
||||
_checkCores:
|
||||
/* Id des Cpu Cores Abfragen */
|
||||
mrc p15, 0, r0, c0, c0, 5
|
||||
/* Falls nicht core 0 Core disablen */
|
||||
tst r0, #3
|
||||
bne _parkCore
|
||||
|
||||
/* not modeled in qemu 6.0 */
|
||||
_enableAlignCheck:
|
||||
/* SCTLR des cp15 laden */
|
||||
mrc p15, 0, r0, c1, c0, 0
|
||||
/* A-bit (c1[1]) auf 1 setzen */
|
||||
orr r0, r0, #0x2
|
||||
/* neues SCTLR speichern */
|
||||
mcr p15, 0, r0, c1, c0, 0
|
||||
|
||||
|
||||
_bsprak:
|
||||
/* Validen Stack Pointer setzten */
|
||||
ldr sp,=0x100000
|
||||
/* Zu c Code springen */
|
||||
bl start_kernel
|
||||
.Lend:
|
||||
WFI
|
||||
b .Lend
|
||||
|
||||
_parkCore:
|
||||
/* Interrupts für Core 1 bis 3 ausschalten */
|
||||
cpsid if
|
||||
/* In Endlosschleife springen */
|
||||
b .Lend
|
||||
|
||||
_exitHyper:
|
||||
|
||||
/* Rücksprungadresse ins Hypervisor Rücksprungregister schreiben.
|
||||
* Dies ist das Label _bsprak für die normale Programmausfürung.
|
||||
*/
|
||||
ldr lr, =_checkCores
|
||||
msr ELR_hyp, lr
|
||||
|
||||
/* Der Hypervisor mode ist auch "nur" eine etwas kompliziertere Exception.
|
||||
* Also springen wir aus dieser zurück.
|
||||
* (Rücksprunge in Aufgabe 2 sind anders zu lösen!).
|
||||
* Dazu zunächst das CPSR auslesen und die Modebits zum Supervisor ändern.
|
||||
* Danach dies in das SPSR für den Rücksprung schreiben.
|
||||
*/
|
||||
mrs r0, cpsr
|
||||
bic r0, r0, #0x1F
|
||||
orr r0, r0, #0x13 //Supervisormode
|
||||
msr spsr_hyp, r0
|
||||
eret
|
||||
Reference in New Issue
Block a user