Update to work on real hardware

This commit is contained in:
Ilja Kartašov 2020-01-29 12:01:32 +01:00
parent 85b0df56bb
commit 21a25ec4e8
21 changed files with 299 additions and 116 deletions

View File

@ -1,4 +1,6 @@
include Makevars.mk ROOT = ./
include ${ROOT}Makevars.mk
# Rules # Rules
# #

View File

@ -3,6 +3,8 @@
# Ilja Kartašov, 2019-11-29 17:38 # Ilja Kartašov, 2019-11-29 17:38
# #
include ${ROOT}kernel/config.mk
BUILD_DIR ?= build/ BUILD_DIR ?= build/
AARCH64_TOOLCHAIN ?= aarch64-linux-gnu AARCH64_TOOLCHAIN ?= aarch64-linux-gnu
@ -33,3 +35,12 @@ AARCH64_QEMU = \
# -kernel /home/elias/git/rpi/boards/pi3/aarch64/uart02/kernel8.img \ # -kernel /home/elias/git/rpi/boards/pi3/aarch64/uart02/kernel8.img \
# vim:ft=make # vim:ft=make
# #
CONFIG_CFLAGS = -D"CONFIG_ARCH=\"${CONFIG_ARCH}\""
CONFIG_CFLAGS = -DCONFIG_ARM_TIMER=${CONFIG_ARM_TIMER}
#ifeq (${CONFIG_HARDWARE}, rpi3)
#CONFIG_CFLAGS += -DCONFIG_HARDWARE_RPI3=1
#else ifeq (${CONFIG_HARDWARE}, qemu)
#CONFIG_CFLAGS += -DCONFIG_HARDWARE_QEMU=1
#endif

View File

@ -1,4 +1,4 @@
# Leos # LeOS
Operating System for ARMv8 (aarch64) Architecture Operating System for ARMv8 (aarch64) Architecture
* [The Idea](#The Idea) * [The Idea](#The Idea)
@ -33,9 +33,9 @@ Early development is going for **Raspberry PI3** board and its emulation using
## Documentation ## Documentation
* [Project structure](docs/project-structure.md) * [Project structure](docs/project-structure.md)
* [Naming convention](docs/naming-convention.md) * [Coding style](docs/coding-style.md)
* [Task scheduling](docs/task-scheduling.md) * Task scheduling
* [Memory management](docs/memory-management.md) * Memory management
## Compilation ## Compilation
@ -56,7 +56,7 @@ To run Löwe OS on Raspberry PI3, follow these steps:
1. Compile project and copy `build/kernel8.img` and `config.txt` files to 1. Compile project and copy `build/kernel8.img` and `config.txt` files to
Micro SD card Micro SD card
2. Make sure latest boot code is installed on the SD card 2. Make sure latest `bootcode.bin` and `start.elf` files are copied to the SD card
3. Insert SD card into your Raspberry PI3 and power it up 3. Insert SD card into your Raspberry PI3 and power it up
## Debug ## Debug
@ -72,8 +72,8 @@ easy as `make debug`.
[x] Memory pages avalability bitmap [x] Memory pages avalability bitmap
[x] Interrupt vectors table [x] Interrupt vectors table
[x] Basic task scheduler [x] Basic task scheduler
[ ] Context switching [x] Context switching
[ ] Memory Mapping Unit [ ] MMU and entering user level
2. Input/output: 2. Input/output:
[ ] Graphical driver [ ] Graphical driver
[ ] USB driver [ ] USB driver

3
config.txt Normal file
View File

@ -0,0 +1,3 @@
arm_control=0x200
kernel_old=1
disable_commandline_tags=1

79
docs/coding-style.md Normal file
View File

@ -0,0 +1,79 @@
# LeOS Coding Style
## Files names
1. Only lower case
2. Words separated with underscore:
```
aarch64/aarch64_boot.S
```
## Preprocessor macro constants
1. Only upper case
2. Words separated with underscore:
```
#define AARCH64_CORE0_TIMER_IRQCTL (*((uint32_t *) 0x40000040))
```
## Types
1. Camel case started from upper case
2. Do not typedef transparent structures
3. Members of structre should be named in camel case started from lower case
```
struct Task {
void *sp;
void *stackStart;
uint32_t pid;
uint32_t stackSize;
uint32_t lock;
uint32_t counter;
uint32_t cycles;
int32_t priority;
uint32_t state;
char name[CONFIG_TASK_MAX_NAME_LEN + 1];
struct Task *next;
};
```
## Constants and variables
1. Global constants and variablesmust be prefixed with `g_`
2. Module (static) constants and variable must be prefixed `m_`
3. Camel case
```
static struct Task *m_currentTask = NULL;
```
## Functions
1. Camel case
2. Prefix separated from function identifier by underscore
3. Static functions may have no prefix
4. Prefix always starts from capital letter
5. Function identifier always starts from lower case verb
```
unsigned int
AArch64_getEL(void);
static struct Task *
scheduleNext(void);
```
## Namespaces and prefixes
1. Due to C has no native namespaces, prefixes should always be used
2. Prefix should match with file name
```
/* file : task.h */
void
Task_initSheduler(void);
```

View File

@ -0,0 +1,10 @@
# Project Structure
* `build/` - temporary output folder
* `docs/` - documentation folder
* `kernel/` - kernel source codes
* `aarch64/` - core AArch64 architecture code
* `drivers/` - code for various drivers
* `leos/` - code of the core LeOS features
* `Makefile` - kernel specific makefile
* `Makefile` - root project makefile

View File

@ -1,6 +1,8 @@
# environment # environment
include ../Makevars.mk ROOT = ../
include ${ROOT}Makevars.mk
# CFLAGS # CFLAGS
@ -65,5 +67,5 @@ $(BUILD_DIR)kernel.sym: $(BUILD_DIR)/kernel.elf
$(BUILD_DIR)%.o: % $(BUILD_DIR)%.o: %
$(info compiling file: $<) $(info compiling file: $<)
@mkdir -p $(dir ./$(BUILD_DIR)$<) @mkdir -p $(dir ./$(BUILD_DIR)$<)
$(AARCH64_CC) $(INCS) $(CFLAGS) -c $< -o $@ $(AARCH64_CC) $(INCS) $(CFLAGS) $(CONFIG_CFLAGS) -c $< -o $@

View File

@ -125,13 +125,25 @@ die:
.globl AArch64_startTask .globl AArch64_startTask
AArch64_startTask: AArch64_startTask:
bl Task_unlockScheduler bl Task_unlockScheduler
blr x1 mov x0, x20
blr x21
hang: hang:
/* todo: implement task exit here */ /* todo: implement task exit here */
WFE WFE
b hang b hang
.globl AArch64_getPState
AArch64_getPState:
mrs x23, NZCV
mrs x3, DAIF
orr x23, x23, x3
mrs x3, CurrentEL
lsr x3, x3, 0x02
/* set third bit: todo: find out its real meaning (registers width?) */
orr x3, x3, 0x04
orr x0, x23, x3
ret
.globl AArch64_switchContext .globl AArch64_switchContext
AArch64_switchContext: AArch64_switchContext:
@ -157,6 +169,7 @@ AArch64_switchContext:
mrs x3, DAIF mrs x3, DAIF
orr x23, x23, x3 orr x23, x23, x3
mrs x3, CurrentEL mrs x3, CurrentEL
lsr x3, x3, 0x02
orr x23, x23, x3 orr x23, x23, x3
stp x30, x30, [sp, 16 * 15] stp x30, x30, [sp, 16 * 15]
@ -227,9 +240,11 @@ el1h_sync:
el1h_irq: el1h_irq:
SAVE_REGISTERS SAVE_REGISTERS
mov x0, sp
bl Task_setStackPointer
bl IRQ_onInterrupt bl IRQ_onInterrupt
cbz x0, load_regs bl Task_getStackPointer
mov sp, x0 /* task context must be switched */ mov sp, x0
load_regs: load_regs:
LOAD_REGISTERS LOAD_REGISTERS
eret eret

View File

@ -16,6 +16,7 @@
#ifndef AARCH64_H_F3AA8888_CEB3_4C16_9835_C3F23B040BB5 #ifndef AARCH64_H_F3AA8888_CEB3_4C16_9835_C3F23B040BB5
#define AARCH64_H_F3AA8888_CEB3_4C16_9835_C3F23B040BB5 #define AARCH64_H_F3AA8888_CEB3_4C16_9835_C3F23B040BB5
#include <leos/types.h>
#include "aarch64_reg.h" #include "aarch64_reg.h"
#include "aarch64_irq.h" #include "aarch64_irq.h"
@ -46,6 +47,9 @@ AArch64_memzero(void *addr, unsigned long size);
extern void extern void
AArch64_startTask(void *arg, void *callback); AArch64_startTask(void *arg, void *callback);
extern uint32_t
AArch64_getPState(void);
extern void extern void
AArch64_switchContext(void *currentTask, void *nextTask); AArch64_switchContext(void *currentTask, void *nextTask);

7
kernel/config.mk Normal file
View File

@ -0,0 +1,7 @@
# Target architecture (AARCH64)
CONFIG_ARCH = AARCH64
# Use ARM local timer (1/0)
CONFIG_ARM_TIMER = 0
-include config.dev.mk

View File

@ -18,38 +18,15 @@
#include <leos/log.h> #include <leos/log.h>
#include "timer.h" #include "timer.h"
const unsigned int m_interval = 2000000; #if CONFIG_ARM_TIMER == 1
const unsigned int m_interval = 500000000;
#else
const unsigned int m_interval = 200000;
#endif
unsigned int m_current = 0; unsigned int m_current = 0;
#ifndef CONFIG_ARM_TIMER
#define CONFIG_ARM_TIMER 1
#endif
#define TIMER_ENABLE ((1 << 31) | (1 << 29) | (1 << 28)) #define TIMER_ENABLE ((1 << 31) | (1 << 29) | (1 << 28))
#define TIMER_RELOAD 1 #define TIMER_RELOAD 5000000
/*
* https://www.raspberrypi.org/forums/viewtopic.php?t=213393
* The sequence on a real PI3 is
* 1.) Route the local timer to a core register 0x40000024 (bits 0..2)
* QA7_rev3.4.pdf page 18 ... say write 0 which is core 0
*
* 2.) Setup timer status control register 0x40000034 (all 32 bits)
* QA7_rev3.4.pdf page 17 ... reload value 5000000 = like half sec, enable clock, enable interrupt
* You can play with clock prescalers etc later.
* 3.) Hit timer interrupt clear and reload register 0x40000038 (bits 30 & 31)
* QA7_rev3.4.pdf page 18 ... write 1 to both bits which clears irq signal and loads value from above
*
* 4.) Setup timer interrupt control register 0x40000040 (all bits ... zero all but the one bit set)
* QA7_rev3.4.pdf page 13 ... now this depends what mode Core0 leaves your bootstub in.
* If you did no EL changes in stub the core0 will still be in Hyp mode if like me you dropped it to SVC mode it is Non Secure
*
* If Core0 enters in Hyp mode ... set nCNTHPIRQ_IRQ bit 1
* If Core0 enters in Svc mode ... set nCNTPNSIRQ_IRQ bit 2
*
* 5.) Now you need to enable global interupts
* asm(" cpsie i")
* */
void void
Timer_init(void) Timer_init(void)
@ -65,28 +42,24 @@ Timer_init(void)
AARCH64_CORE0_TIMER_IRQCTL = (1 << 1); /* nCNTPNSIR1 - Non Secure*/ AARCH64_CORE0_TIMER_IRQCTL = (1 << 1); /* nCNTPNSIR1 - Non Secure*/
#else #else
m_current = aarch64_get32r(TIMER_CLO); m_current = AArch64_getReg32(TIMER_CLO);
m_current += m_interval; m_current += m_interval;
aarch64_set32r(TIMER_C1, m_current); AArch64_setReg32(TIMER_C1, m_current);
#endif #endif
} }
void void
Timer_incFromISR(void) Timer_incFromISR(void)
{ {
m_current++; /*= m_interval;*/ m_current += m_interval;
#if CONFIG_ARM_TIMER == 1 #if CONFIG_ARM_TIMER == 1
/* clear interrupt flag and reload timer */ /* clear interrupt flag and reload timer */
// AARCH64_LOCAL_TIMER_STATCTL |= TIMER_RELOAD;
AARCH64_LOCAL_TIMER_RECLR |= (1 << 31) | (1 << 30); AARCH64_LOCAL_TIMER_RECLR |= (1 << 31) | (1 << 30);
#else #else
aarch64_set32r(TIMER_C1, m_current); AArch64_setReg32(TIMER_C1, m_current);
aarch64_set32r(TIMER_CS, TIMER_CS_M1); AArch64_setReg32(TIMER_CS, TIMER_CS_M1);
#endif #endif
/*
Log_putS("--- tick --- ");
Log_putI(m_current, 10);
Log_putS(" ---\r\n");
*/
} }
uint32_t uint32_t

View File

@ -39,11 +39,11 @@ static const char *m_types[] = {
}; };
static void * static void
IRQ_onTimerInterrupt(void) IRQ_onTimerInterrupt(void)
{ {
Timer_incFromISR(); Timer_incFromISR();
return Task_scheduleFromISR(); Task_scheduleFromISR();
} }
void void
@ -52,13 +52,15 @@ IRQ_init()
AArch64_setReg32(ENABLE_IRQS_1, SYSTEM_TIMER_IRQ_1); AArch64_setReg32(ENABLE_IRQS_1, SYSTEM_TIMER_IRQ_1);
} }
void * void
IRQ_onInterrupt(void) IRQ_onInterrupt(void)
{ {
unsigned int irq = AArch64_getReg32(IRQ_PENDING_1); unsigned int irq = AArch64_getReg32(IRQ_PENDING_1);
switch(irq) { switch(irq) {
#if CONFIG_ARM_TIMER == 1
case LOCAL_TIMER_IRQ: case LOCAL_TIMER_IRQ:
#endif
case SYSTEM_TIMER_IRQ_1: case SYSTEM_TIMER_IRQ_1:
return IRQ_onTimerInterrupt(); return IRQ_onTimerInterrupt();
@ -67,7 +69,6 @@ IRQ_onInterrupt(void)
Log_putU(irq, 16); Log_putU(irq, 16);
Log_putS("\n"); Log_putS("\n");
} }
return 0; /* do not change stack pointer */
} }
void void

View File

@ -21,7 +21,7 @@
void void
IRQ_init(void); IRQ_init(void);
void * void
IRQ_onInterrupt(void); IRQ_onInterrupt(void);
void void

View File

@ -13,14 +13,18 @@
* @see https://lowenware.com/ * @see https://lowenware.com/
*/ */
#include <leos/log.h>
#include <leos/irq.h> #include <leos/irq.h>
#include <leos/leos.h> #include <leos/leos.h>
#include <leos/log.h>
#include <leos/memory.h>
#include <leos/task.h> #include <leos/task.h>
#include <drivers/timer/timer.h> #include <drivers/timer/timer.h>
void void
Leos_demoTask(void *arg); Leos_demoTask1(void *arg);
void
Leos_demoTask2(void *arg);
void void
@ -36,27 +40,38 @@ Leos_run(void)
IRQ_init(); IRQ_init();
Timer_init(); Timer_init();
IRQ_enable(); Memory_init();
Task_initSheduler(); Task_initSheduler();
if (Task_create(Leos_demoTask, "Task 1") == -1)
IRQ_enable();
if (Task_create(Leos_demoTask1, "T1") == -1)
Log_putS("Task 1 was not created\r\n"); Log_putS("Task 1 was not created\r\n");
if (Task_create(Leos_demoTask2, "T2") == -1)
Log_putS("Task 2 was not created\r\n");
for (;;) { for (;;) {
Log_putU(Timer_getTicks(), 10); Log_putS("I");
Log_putS(". Idle Task\r\n");
Task_yield(); Task_yield();
} }
} }
void void
Leos_demoTask(void *arg) Leos_demoTask2(void *arg)
{ {
for (;;) { for (;;) {
Log_putU(Timer_getTicks(), 10); Log_putS("B");
Log_putS(". "); Task_yield();
Log_putS((const char *)arg); }
Log_putS("\r\n"); }
void
Leos_demoTask1(void *arg)
{
for (;;) {
Log_putS("A");
Task_yield(); Task_yield();
} }
} }

View File

@ -15,12 +15,20 @@
*/ */
#include <stdlib.h> #include <stdlib.h>
#include <aarch64/aarch64.h>
#include <drivers/soc/bcm2837/bcm2837.h> #include <drivers/soc/bcm2837/bcm2837.h>
#include "memory.h" #include "memory.h"
#include "log.h" #include "log.h"
static unsigned long m_map[MEMORY_PAGE_COUNT / sizeof(unsigned long) / 8] = {0,}; static unsigned long m_map[MEMORY_PAGE_COUNT / sizeof(unsigned long) / 8];
static int m_ix = 0; static int m_ix;
void
Memory_init(void)
{
m_ix = 0;
AArch64_memzero(m_map, sizeof(m_map));
}
void * void *
Memory_getPage(void) Memory_getPage(void)
@ -28,7 +36,6 @@ Memory_getPage(void)
int i, j; int i, j;
unsigned long map; unsigned long map;
for (i = m_ix; i < sizeof(m_map) / sizeof(m_map[0]); i++) { for (i = m_ix; i < sizeof(m_map) / sizeof(m_map[0]); i++) {
map = m_map[i]; map = m_map[i];
for (j = 0; j < 8 * sizeof(map); j++) { for (j = 0; j < 8 * sizeof(map); j++) {

View File

@ -16,6 +16,10 @@
#ifndef MEMORY_H_C583E24E_55B0_49EF_99C9_5A36B04468AC #ifndef MEMORY_H_C583E24E_55B0_49EF_99C9_5A36B04468AC
#define MEMORY_H_C583E24E_55B0_49EF_99C9_5A36B04468AC #define MEMORY_H_C583E24E_55B0_49EF_99C9_5A36B04468AC
void
Memory_init(void);
void * void *
Memory_getPage(void); Memory_getPage(void);

View File

@ -16,11 +16,13 @@
#include <stdlib.h> #include <stdlib.h>
#include <aarch64/aarch64.h> #include <aarch64/aarch64.h>
#include <drivers/soc/bcm2837/bcm2837.h> #include <drivers/soc/bcm2837/bcm2837.h>
#include <drivers/timer/timer.h>
#include "memory.h" #include "memory.h"
#include "log.h" #include "log.h"
#include "task.h" #include "task.h"
#define TASK_STATE_RUNNING 0 #define TASK_STATE_RUNNING 0
#define TASK_STATE_HALFCYCLE (1 << 8)
#ifndef CONFIG_IDLE_TASK_STACK_SIZE #ifndef CONFIG_IDLE_TASK_STACK_SIZE
#define CONFIG_IDLE_TASK_STACK_SIZE 0x4000 #define CONFIG_IDLE_TASK_STACK_SIZE 0x4000
@ -46,21 +48,8 @@ struct __attribute__((packed)) TaskContext {
uint64_t spsr_el1; uint64_t spsr_el1;
}; };
static struct Task *m_currentTask = NULL static struct Task *m_currentTask, *m_lastTask, m_idleTask;
, *m_lastTask = NULL
, m_idleTask = {
.sp = NULL
, .stackStart = NULL
, .stackSize = CONFIG_IDLE_TASK_STACK_SIZE
, .pid = 1
, .lock = 1
, .counter = 1
, .cycles = 1
, .priority = 0
, .state = TASK_STATE_RUNNING
, .name = {'I', 'D', 'L', 'E', 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}
, .next = NULL
};
static uint32_t m_pid = 1; static uint32_t m_pid = 1;
@ -70,7 +59,9 @@ scheduleNext(void)
struct Task *i, *next = NULL; struct Task *i, *next = NULL;
int32_t priority = -1; int32_t priority = -1;
Log_putS("scheduleNext\r\n "); if (m_currentTask->counter)
m_currentTask->counter--;
for (;;) { for (;;) {
/* check urgent tasks */ /* check urgent tasks */
for (i = &m_idleTask; i != NULL; i = i->next) { for (i = &m_idleTask; i != NULL; i = i->next) {
@ -81,10 +72,6 @@ scheduleNext(void)
priority = i->priority; priority = i->priority;
next = i; next = i;
} }
if (!i->state && i->counter > priority) {
priority = i->priority;
next = i;
}
} }
if (next) { if (next) {
@ -96,10 +83,6 @@ scheduleNext(void)
} }
} }
Log_putS("\t switch: ");
Log_putU((uint64_t)next->pid, 10);
Log_putS("\n");
return next; return next;
} }
@ -107,6 +90,24 @@ void
Task_initSheduler(void) Task_initSheduler(void)
{ {
struct Task *idleTask = &m_idleTask; struct Task *idleTask = &m_idleTask;
m_pid = 1;
m_idleTask.sp = NULL;
m_idleTask.stackStart = NULL;
m_idleTask.stackSize = CONFIG_IDLE_TASK_STACK_SIZE;
m_idleTask.pid = 1;
m_idleTask.lock = 1;
m_idleTask.counter = 1;
m_idleTask.cycles = 1;
m_idleTask.priority = 0;
m_idleTask.state = TASK_STATE_RUNNING;
m_idleTask.name[0] = 'I';
m_idleTask.name[1] = 'D';
m_idleTask.name[2] = 'L';
m_idleTask.name[3] = 'E';
m_idleTask.name[4] = 0;
m_idleTask.next = NULL;
m_currentTask = idleTask; m_currentTask = idleTask;
m_lastTask = idleTask; m_lastTask = idleTask;
Task_unlockScheduler(); Task_unlockScheduler();
@ -121,6 +122,12 @@ Task_create(TaskCallback callback, void *arg)
if (!task) if (!task)
return -1; return -1;
Log_putS("Task @0x");
Log_putU((uint64_t) task, 16);
Log_putS(" - ");
Log_putU(((uint64_t) task) + MEMORY_PAGE_SIZE, 16);
Log_putS("\r\n");
task->sp = (void *)task + MEMORY_PAGE_SIZE - 272; task->sp = (void *)task + MEMORY_PAGE_SIZE - 272;
task->stackStart = task->sp; task->stackStart = task->sp;
task->stackSize = MEMORY_PAGE_SIZE - sizeof(*task); task->stackSize = MEMORY_PAGE_SIZE - sizeof(*task);
@ -138,10 +145,11 @@ Task_create(TaskCallback callback, void *arg)
task->next = 0; task->next = 0;
ctx = (struct TaskContext *) task->sp; ctx = (struct TaskContext *) task->sp;
ctx->x[0] = (uint64_t) arg; ctx->x[20] = (uint64_t) arg;
ctx->x[1] = (uint64_t) callback; ctx->x[21] = (uint64_t) callback;
ctx->x[30] = (uint64_t) AArch64_startTask; ctx->x[30] = (uint64_t) AArch64_startTask;
ctx->elr_el1 = (uint64_t) AArch64_startTask; ctx->elr_el1 = (uint64_t) AArch64_startTask;
ctx->spsr_el1 = AArch64_getPState();
Task_lockScheduler(); Task_lockScheduler();
m_lastTask->next = task; m_lastTask->next = task;
@ -154,25 +162,41 @@ Task_create(TaskCallback callback, void *arg)
void void
Task_yield(void) Task_yield(void)
{ {
struct Task *next, *prev = m_currentTask; #if 1
uint64_t ticks = Timer_getTicks();
Log_putS("Task_yield()\r\n");
Task_lockScheduler(); Task_lockScheduler();
Log_putS("^");
m_currentTask->counter = 0;
Task_unlockScheduler();
__asm__("WFE");
while (ticks == Timer_getTicks());
#else
/* Task yield should be solved differently */
struct Task *next, *prev;
Task_lockScheduler();
Log_putS("^");
prev = m_currentTask;
prev->counter = 0; prev->counter = 0;
next = scheduleNext(); next = scheduleNext();
if (next != prev) { if (next != prev) {
next->state |= TASK_STATE_HALFCYCLE;
m_currentTask = next; m_currentTask = next;
Task_unlockScheduler();
AArch64_switchContext(prev, next); AArch64_switchContext(prev, next);
/* newly created tasks never exit here, that is why in AArch64_startTask /* `next` tasks never exits here, but in AArch64_startTask,
* there is own Task_unlockScheduler() call * that is why there is an own Task_unlockScheduler() call
* */ * */
} else { } else {
__asm__("WFE"); // __asm__("WFE");
} }
Task_unlockScheduler(); Task_unlockScheduler();
#endif
} }
void void
@ -184,35 +208,55 @@ Task_lockScheduler(void)
void void
Task_unlockScheduler(void) Task_unlockScheduler(void)
{ {
if (m_currentTask->lock)
m_currentTask->lock--; m_currentTask->lock--;
} }
void * void
Task_scheduleFromISR(void) Task_scheduleFromISR(void)
{ {
void *sp = NULL;
# if 0
if (m_currentTask->counter)
m_currentTask->counter--;
if (!m_currentTask->lock) { if (!m_currentTask->lock) {
struct Task *next; struct Task *next;
Log_putS("Task_scheduleFromISR\r\n");
if (m_currentTask->state & TASK_STATE_HALFCYCLE) {
m_currentTask->state &= ~TASK_STATE_HALFCYCLE;
return;
}
Log_putS("!");
Task_lockScheduler(); Task_lockScheduler();
next = scheduleNext(); next = scheduleNext();
if (next != m_currentTask) { if (next != m_currentTask) {
m_currentTask = next; m_currentTask = next;
sp = next->sp;
} }
/* unlock call could be moved to aarch64.S interrupt handler in case of /* unlock call could be moved to aarch64.S interrupt handler in case of
* issue * issue
* */ * */
Task_unlockScheduler(); Task_unlockScheduler();
} }
#endif }
return sp; void *
Task_getStackPointer(void)
{
/*
Log_putS("gSP:");
Log_putU((uint64_t)m_currentTask->sp, 16);
Log_putS("\r\n");
*/
return m_currentTask->sp;
}
void
Task_setStackPointer(void *sp)
{
/*
Log_putS("sSP:");
Log_putU((uint64_t)sp, 16);
Log_putS("\r\n");
*/
m_currentTask->sp = sp;
} }

View File

@ -39,7 +39,13 @@ Task_lockScheduler(void);
void void
Task_unlockScheduler(void); Task_unlockScheduler(void);
void * void
Task_scheduleFromISR(void); Task_scheduleFromISR(void);
void *
Task_getStackPointer(void);
void
Task_setStackPointer(void *sp);
#endif /* !TASK_H */ #endif /* !TASK_H */