From 20fa8584e31d55b7f2953f917adcc190adab236f Mon Sep 17 00:00:00 2001 From: Christian Cunningham Date: Tue, 31 Aug 2021 08:31:10 -0700 Subject: Initial Commit --- src/boot.S | 135 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ src/irq.S | 0 src/kernel.S | 24 +++++++++++ src/uart.S | 46 ++++++++++++++++++++ 4 files changed, 205 insertions(+) create mode 100644 src/boot.S create mode 100644 src/irq.S create mode 100644 src/kernel.S create mode 100644 src/uart.S (limited to 'src') diff --git a/src/boot.S b/src/boot.S new file mode 100644 index 0000000..f0caebc --- /dev/null +++ b/src/boot.S @@ -0,0 +1,135 @@ +// To keep this in the first portion of the binary. +.section ".text.boot" + +// Make _start global. +.globl _start + +_start: +reset: + // disable core0,1,2. + mrc p15, #0, r1, c0, c0, #5 + and r1, r1, #3 + cmp r1, #0 + bne io_halt + + // set vector address. + ldr r0, =vector + mcR P15, 0, r0, c12, c0, 0 + + // save cpsr. + mrs r0, cpsr + + // setup sp in IRQ mode. + bic r1, r0, #0x1f + orr r1, r1, #0x12 + msr cpsr_c,r1 + mov sp,#0x4000 + + // restore cpsr. + msr cpsr_c, r0 + + // setup the stack in SVC mode. + mov sp, #0x8000 + + // Clear out bss. + ldr r4, =__bss_start + ldr r9, =__bss_end + mov r5, #0 + mov r6, #0 + mov r7, #0 + mov r8, #0 + b 2f + +1: + // store multiple at r4. + stmia r4!, {r5-r8} + + // If we are still below bss_end, loop. +2: + cmp r4, r9 + blo 1b + + // Call kernel_main + ldr r3, =kernel_main + blx r3 + +irq: + push {r0,r1,r2,r3,r4,r5,r6,r7,r8,r9,r10,r11,r12,lr} + bl a_irq_handler + pop {r0,r1,r2,r3,r4,r5,r6,r7,r8,r9,r10,r11,r12,lr} + subs pc, lr, #4 + +.globl io_halt +io_halt: + wfi + b io_halt + +.globl enable_irq +enable_irq: + cpsie i + bx lr + +.globl disable_irq +disable_irq: + cpsid i + bx lr + +.align 5 +vector: + ldr pc, reset_handler + ldr pc, undefined_handler + ldr pc, swi_handler + ldr pc, prefetch_handler + ldr pc, data_handler + ldr pc, unused_handler + ldr pc, irq_handler + ldr pc, fiq_handler + +reset_handler: .word reset +undefined_handler: .word io_halt +swi_handler: .word io_halt +prefetch_handler: .word io_halt +data_handler: .word io_halt +unused_handler: .word io_halt +irq_handler: .word irq +fiq_handler: .word io_halt + +.global a_irq_handler +a_irq_handler: + push {lr} + bl disable_irq + // r2 = CORE0_INTERRUPT_SOURCE + // if r2 & 0b100000000 + mov r2, #0x40000000 + ldr r3, [r2, #0x60] + tst r3, #256 + beq a_irq_handler.exit + // r2 = IRQ_PEND2 + // r2 & 1 << 25 + mov r2, #0xB208 + movt r2, #0x3F00 + ldr r3, [r2] + tst r3, #0x2000000 + beq a_irq_handler.exit + mov r2, #0x1040 + movt r2, #0x3F20 + ldr r3, [r2] + tst r3, #16 + beq a_irq_handler.exit + mov r2, #0x1000 + movt r2, #0x3F20 + ldrb r0, [r2] + push {r0} + bl enable_irq + pop {r0} + bl uart_char + ldr r0, =amsg + bl uart_string + pop {pc} +a_irq_handler.exit: + bl enable_irq + pop {pc} + +.section ".data" +amsg: + .asciz " a_irq_handler\n" diff --git a/src/irq.S b/src/irq.S new file mode 100644 index 0000000..e69de29 diff --git a/src/kernel.S b/src/kernel.S new file mode 100644 index 0000000..02894a6 --- /dev/null +++ b/src/kernel.S @@ -0,0 +1,24 @@ +.section ".text.kernel" + +.globl kernel_main +kernel_main: + push {lr} + bl uart_init + bl enable_irq + ldr r0, =os_info + bl uart_string + mov r0, #0x00 +kernel_main.a: + cmp r0, #0x100 + beq kernel_main.loop + bl uart_char + add r0, #1 + b kernel_main.a +kernel_main.loop: + bl io_halt + b kernel_main.loop + pop {lr} + +.section ".data" +os_info: + .asciz "Sergey Bilovytskyy's Real Time Operating System\n Version 0.0a\n Interrupt 01: uart rx interrupt\n Exit : Ctrl-A x\n Monitor : Ctrl-A c\n\n" diff --git a/src/uart.S b/src/uart.S new file mode 100644 index 0000000..bd98bac --- /dev/null +++ b/src/uart.S @@ -0,0 +1,46 @@ +.section ".text" + +.globl uart_init +uart_init: + //*UART0_IMSC = 1 << 4; + mov r2, #0x1038 + movt r2, #0x3F20 + mov r3, #0b10000 + str r3, [r2] + //*IRQ_ENABLE2 = 1 << 25; + mov r2, #0xB214 + movt r2, #0x3F00 + mov r3, #0 + movt r3, #0b1000000000 + str r3, [r2] + //*GPU_INTERRUPTS_ROUTING = 0x00; + mov r2, #0x000C + movt r2, #0x4000 + eor r3, r3 + str r3, [r2] + bx lr + +.globl uart_char +uart_char: + mov r2, #0x1000 + movt r2, #0x3f20 +uart_char.loop: + ldr r3, [r2, #24] + tst r3, #0b100000 + bne uart_char.loop + str r0, [r2] + bx lr + +.globl uart_string +uart_string: + push {r4, lr} + mov r4, r0 + ldrb r0, [r0] + cmp r0, #0 + popeq {r4, pc} +uart_string.loop: + bl uart_char + ldrb r0, [r4, #1]! + cmp r0, #0 + bne uart_string.loop + pop {r4, pc} -- cgit v1.2.1