Add assembly constants file
This commit is contained in:
@@ -2,6 +2,8 @@
|
||||
# v. 2.0. If a copy of the MPL was not distributed with this file, You can
|
||||
# obtain one at https://mozilla.org/MPL/2.0/.
|
||||
|
||||
.include "./arch/riscv/constants.s"
|
||||
|
||||
.section .text
|
||||
|
||||
# a0 - First pointer.
|
||||
@@ -237,3 +239,70 @@ memset:
|
||||
|
||||
.Lmemset_end:
|
||||
ret
|
||||
|
||||
# Maps a page of physical memory to the identical virtual memory.
|
||||
#
|
||||
# Parameters:
|
||||
# a0 - Corresponding virtual address.
|
||||
# a1 - Physical page address.
|
||||
# a2 - Free memory page that can be used to create a leaf page table.
|
||||
# a3 - Page table level. If a3 is 0 a superpage is allocated, otherwise a normal page.
|
||||
# a4 - Flags.
|
||||
#
|
||||
# If the function creates new page tables in a2, it advances a2 by the page size and
|
||||
# returns it in a0.
|
||||
.type pmem_map_at, @function
|
||||
.globl pmem_map_at
|
||||
pmem_map_at:
|
||||
csrr t0, satp
|
||||
slli t0, t0, 12 # Root table address.
|
||||
|
||||
li t4, 0xfffffc00
|
||||
li t5, 0xffc # 10 bit * PTESIZE mask.
|
||||
li t1, 20
|
||||
|
||||
.Lpmem_map_at_loop:
|
||||
# Multiply VPN[i] by 4 and add to the start address of the page table.
|
||||
# This gives the physical address of the page table entry.
|
||||
srl t2, a0, t1
|
||||
and t2, t2, t5 # VPN[i] * PTESIZE.
|
||||
add t2, t0, t2 # a + VPN[i] * PTESIZE.
|
||||
|
||||
beqz a3, .Lpmem_map_at_leaf
|
||||
|
||||
lw t3, (t2)
|
||||
andi t6, t3, 0b1
|
||||
|
||||
beqz t6, .Lpmem_map_at_create
|
||||
|
||||
and t0, t3, t4
|
||||
slli t0, t0, 2
|
||||
|
||||
j .Lpmem_map_at_next
|
||||
|
||||
.Lpmem_map_at_create:
|
||||
# Take a chunk of free memory and use it as the next page table.
|
||||
# The beginning addres off the chunk is the base address (a) for the next level.
|
||||
mv t0, a2
|
||||
srli t3, t0, 2
|
||||
ori t3, t3, 0b1
|
||||
sw t3, (t2)
|
||||
|
||||
li t6, PAGE_SIZE
|
||||
add a2, a2, t6
|
||||
|
||||
.Lpmem_map_at_next:
|
||||
# Calculate the next page table address for the next level.
|
||||
addi t1, t1, -10
|
||||
addi a3, a3, -1
|
||||
|
||||
j .Lpmem_map_at_loop
|
||||
|
||||
.Lpmem_map_at_leaf:
|
||||
srli t3, a1, 2 # Physical page number mapped to 12 bits of the page table entry.
|
||||
ori a4, a4, 0b1
|
||||
or t3, t3, a4 # Execute, write, read and valid.
|
||||
sw t3, (t2)
|
||||
|
||||
mv a0, a2
|
||||
ret
|
||||
|
1
arch/riscv/constants.s
Normal file
1
arch/riscv/constants.s
Normal file
@@ -0,0 +1 @@
|
||||
.equ PAGE_SIZE, 4096
|
@@ -2,6 +2,8 @@
|
||||
# v. 2.0. If a copy of the MPL was not distributed with this file, You can
|
||||
# obtain one at https://mozilla.org/MPL/2.0/.
|
||||
|
||||
.include "./arch/riscv/constants.s"
|
||||
|
||||
.section .rodata
|
||||
|
||||
panic_message: .asciz "\nPanic"
|
||||
@@ -104,12 +106,10 @@ set_up_stack:
|
||||
# a1 - Memory end pointer.
|
||||
.type imem_zero, @function
|
||||
imem_zero:
|
||||
mv t0, a0
|
||||
|
||||
.Limem_zero_loop:
|
||||
bgeu t0, a1, .Limem_zero_end
|
||||
sw zero, (t0)
|
||||
addi t0, t0, 4
|
||||
bgeu a0, a1, .Limem_zero_end
|
||||
sw zero, (a0)
|
||||
addi a0, a0, 4
|
||||
|
||||
j .Limem_zero_loop
|
||||
|
||||
@@ -125,7 +125,7 @@ imem_mirror:
|
||||
csrr t0, satp
|
||||
slli t0, t0, 12
|
||||
|
||||
li t3, 0x1000
|
||||
li t3, PAGE_SIZE
|
||||
add t1, t0, t3 # Original page table.
|
||||
add t2, t1, t3 # Copied page table.
|
||||
|
||||
@@ -167,9 +167,10 @@ imem_initialize:
|
||||
sw s1, 16(sp)
|
||||
sw s2, 12(sp)
|
||||
sw s3, 8(sp)
|
||||
sw a0, 4(sp)
|
||||
|
||||
# Set s1 to the beginning of free memory (skipping root page table).
|
||||
li s1, 4096
|
||||
li s1, PAGE_SIZE
|
||||
add s1, a1, s1
|
||||
|
||||
slli a3, a3, 1 # Multiply by two to account for the copy in virtual memory.
|
||||
@@ -190,28 +191,28 @@ imem_initialize:
|
||||
srli t0, a1, 12
|
||||
csrw satp, t0
|
||||
|
||||
# Zero memory for page tables.
|
||||
mv a0, a1
|
||||
add a1, s1, a3
|
||||
call imem_zero
|
||||
|
||||
# Executable section.
|
||||
# a0 is coming from the parameter.
|
||||
addi a1, s2, %lo(etext)
|
||||
mv a2, s1
|
||||
li a3, 1
|
||||
li a4, 0b1010
|
||||
mv a0, s1
|
||||
lw a1, 4(sp)
|
||||
addi a2, s2, %lo(etext)
|
||||
li a3, 0b1010 # Read and execute.
|
||||
jal imem_map_range
|
||||
|
||||
# Read only section.
|
||||
addi a0, s2, %lo(etext)
|
||||
addi a1, s3, %lo(_data)
|
||||
mv a2, s1
|
||||
li a3, 1
|
||||
li a4, 0b0010
|
||||
addi a1, s2, %lo(etext)
|
||||
addi a2, s3, %lo(_data)
|
||||
li a3, 0b0010 # Read.
|
||||
jal imem_map_range
|
||||
|
||||
# Data section.
|
||||
addi a0, s3, %lo(_data)
|
||||
lw a1, 20(sp)
|
||||
mv a2, s1
|
||||
li a3, 1
|
||||
li a4, 0b0110
|
||||
addi a1, s3, %lo(_data)
|
||||
lw a2, 20(sp)
|
||||
li a3, 0b0110 # Read and write.
|
||||
jal imem_map_range
|
||||
|
||||
# Enable paging.
|
||||
@@ -236,11 +237,12 @@ imem_initialize:
|
||||
# Maps multiple pages of physical memory to the identical virtual memory.
|
||||
#
|
||||
# Parameters:
|
||||
# a0 - Start address.
|
||||
# a1 - End address.
|
||||
# a2 - Start of the free memory that can be used to create leaf page tables.
|
||||
# a3 - Page table level. If a3 is 0 a superpage is allocated, otherwise a normal page.
|
||||
# a4 - Flags.
|
||||
# a0 - Start of the free memory that can be used to create leaf page tables.
|
||||
# a1 - Start address.
|
||||
# a2 - End address.
|
||||
# a3 - Flags.
|
||||
#
|
||||
# If the function creates new page tables it advances and returns a0.
|
||||
.type imem_map_range, @function
|
||||
imem_map_range:
|
||||
# Prologue.
|
||||
@@ -250,27 +252,30 @@ imem_map_range:
|
||||
addi s0, sp, 32
|
||||
|
||||
sw s1, 20(sp)
|
||||
sw a2, 16(sp)
|
||||
sw a3, 12(sp)
|
||||
sw a4, 8(sp)
|
||||
sw s2, 16(sp)
|
||||
sw s3, 12(sp)
|
||||
sw s4, 8(sp)
|
||||
|
||||
mv s1, a1
|
||||
mv s2, a2
|
||||
li s3, PAGE_SIZE
|
||||
mv s4, a3
|
||||
|
||||
.Limem_map_range_loop:
|
||||
bge a0, s1, .Limem_map_range_end
|
||||
bge s1, s2, .Limem_map_range_end
|
||||
|
||||
mv a1, a0
|
||||
lw a2, 16(sp)
|
||||
lw a3, 12(sp)
|
||||
lw a4, 8(sp)
|
||||
mv a1, s1
|
||||
mv a2, s4
|
||||
jal imem_map_at
|
||||
|
||||
li t0, 4096
|
||||
add a0, a0, t0
|
||||
add s1, s1, s3
|
||||
|
||||
j .Limem_map_range_loop
|
||||
|
||||
.Limem_map_range_end:
|
||||
lw s4, 8(sp)
|
||||
lw s3, 12(sp)
|
||||
lw s2, 16(sp)
|
||||
lw s1, 20(sp)
|
||||
|
||||
# Epilogue.
|
||||
@@ -282,62 +287,53 @@ imem_map_range:
|
||||
# Maps a page of physical memory to the identical virtual memory.
|
||||
#
|
||||
# Parameters:
|
||||
# a0 - Corresponding virtual address.
|
||||
# a0 - Free memory page that can be used to create a leaf page table.
|
||||
# a1 - Physical page address.
|
||||
# a2 - Free memory page that can be used to create a leaf page table.
|
||||
# a3 - Page table level. If a3 is 0 a superpage is allocated, otherwise a normal page.
|
||||
# a4 - Flags.
|
||||
# a2 - Flags.
|
||||
#
|
||||
# Returns virtual page address in a0.
|
||||
# If the function creates new page tables it advances and returns a0.
|
||||
.type imem_map_at, @function
|
||||
imem_map_at:
|
||||
csrr t0, satp
|
||||
slli t0, t0, 12 # Root table address.
|
||||
|
||||
li t4, 0xfffffc00
|
||||
li t5, 0xffc # 10 bit * PTESIZE mask.
|
||||
li t1, 20
|
||||
li t1, 0xffc # 10 bit * PTESIZE mask.
|
||||
|
||||
.Limem_map_at_loop:
|
||||
# Multiply VPN[i] by 4 and add to the start address of the page table.
|
||||
# This gives the physical address of the page table entry.
|
||||
srl t2, a0, t1
|
||||
and t2, t2, t5 # VPN[i] * PTESIZE.
|
||||
add t2, t0, t2 # a + VPN[i] * PTESIZE.
|
||||
|
||||
beqz a3, .Limem_map_at_leaf
|
||||
srli t2, a1, 20
|
||||
and t2, t2, t1 # VPN[1] * PTESIZE.
|
||||
add t2, t0, t2 # a + VPN[1] * PTESIZE.
|
||||
|
||||
lw t3, (t2)
|
||||
andi t6, t3, 0b1
|
||||
andi t4, t3, 0b1
|
||||
|
||||
beqz t6, .Limem_map_at_create
|
||||
beqz t4, .Limem_map_at_create
|
||||
|
||||
li t4, 0xfffffc00
|
||||
and t0, t3, t4
|
||||
slli t0, t0, 2
|
||||
|
||||
j .Limem_map_at_next
|
||||
j .Limem_map_at_existing
|
||||
|
||||
.Limem_map_at_create:
|
||||
# Take a chunk of free memory and use it as the next page table.
|
||||
# The beginning addres off the chunk is the base address (a) for the next level.
|
||||
mv t0, a2
|
||||
mv t0, a0
|
||||
srli t3, t0, 2
|
||||
ori t3, t3, 0b1
|
||||
sw t3, (t2)
|
||||
|
||||
.Limem_map_at_next:
|
||||
# Calculate the next page table address for the next level.
|
||||
addi t1, t1, -10
|
||||
addi a3, a3, -1
|
||||
li t4, PAGE_SIZE
|
||||
add a0, a0, t4
|
||||
|
||||
j .Limem_map_at_loop
|
||||
.Limem_map_at_existing:
|
||||
srli t2, a1, 10
|
||||
and t2, t2, t1 # VPN[0] * PTESIZE.
|
||||
add t2, t0, t2 # a + VPN[0] * PTESIZE.
|
||||
|
||||
.Limem_map_at_leaf:
|
||||
srli t3, a1, 2 # Physical page number mapped to 12 bits of the page table entry.
|
||||
ori a4, a4, 0b1
|
||||
or t3, t3, a4 # Execute, write, read and valid.
|
||||
ori a2, a2, 0b1
|
||||
or t3, t3, a2 # Execute, write, read and valid.
|
||||
sw t3, (t2)
|
||||
|
||||
ret
|
||||
|
||||
.section .text
|
||||
@@ -361,7 +357,7 @@ kernel_main:
|
||||
lw a2, 20(sp)
|
||||
li a3, 0
|
||||
li a4, 0b0010
|
||||
call imem_map_at
|
||||
call pmem_map_at
|
||||
|
||||
lw a0, 16(sp)
|
||||
call device_tree
|
||||
|
Reference in New Issue
Block a user