The-Homebrew-Cloud/SummerCart64
2
0
Fork 0
mirror of https://github.com/Polprzewodnikowy/SummerCart64.git synced 2024-11-22 05:59:15 +01:00
Code Issues Packages Projects Releases Wiki Activity

interrupts disable macro

Browse Source
This commit is contained in:
Mateusz Faderewski 2024-05-27 22:52:33 +02:00
parent 392ad5bece
commit 759df3b0f3
2 changed files with 28 additions and 20 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
sw/bootloader/src/interrupts.h
View File

@ -5,6 +5,13 @@
#include <stdint.h>
#define WITH_INTERRUPTS_DISABLED(x) { \
uint32_t __sr = interrupts_disable(); \
{ x } \
interrupts_restore(__sr); \
}
void interrupts_init (void);
uint32_t interrupts_disable (void);
void interrupts_restore (uint32_t sr);

41
sw/bootloader/src/io.c
View File

@ -73,38 +73,39 @@ uint32_t pi_busy (void) {
}
uint32_t pi_io_read (io32_t *address) {
uint32_t sr = interrupts_disable();
while (pi_busy());
uint32_t value = cpu_io_read(address);
interrupts_restore(sr);
uint32_t value;
WITH_INTERRUPTS_DISABLED({
while (pi_busy());
value = cpu_io_read(address);
});
return value;
}
void pi_io_write (io32_t *address, uint32_t value) {
uint32_t sr = interrupts_disable();
while (pi_busy());
cpu_io_write(address, value);
interrupts_restore(sr);
WITH_INTERRUPTS_DISABLED({
while (pi_busy());
cpu_io_write(address, value);
});
}
void pi_dma_read (io32_t *address, void *buffer, size_t length) {
cache_data_hit_writeback_invalidate(buffer, length);
uint32_t sr = interrupts_disable();
while (pi_busy());
cpu_io_write(&PI->PADDR, (uint32_t) (PHYSICAL(address)));
cpu_io_write(&PI->MADDR, (uint32_t) (PHYSICAL(buffer)));
cpu_io_write(&PI->WDMA, length - 1);
interrupts_restore(sr);
WITH_INTERRUPTS_DISABLED({
while (pi_busy());
cpu_io_write(&PI->PADDR, (uint32_t) (PHYSICAL(address)));
cpu_io_write(&PI->MADDR, (uint32_t) (PHYSICAL(buffer)));
cpu_io_write(&PI->WDMA, length - 1);
});
while (pi_busy());
}
void pi_dma_write (io32_t *address, void *buffer, size_t length) {
cache_data_hit_writeback(buffer, length);
uint32_t sr = interrupts_disable();
while (pi_busy());
cpu_io_write(&PI->PADDR, (uint32_t) (PHYSICAL(address)));
cpu_io_write(&PI->MADDR, (uint32_t) (PHYSICAL(buffer)));
cpu_io_write(&PI->RDMA, length - 1);
interrupts_restore(sr);
WITH_INTERRUPTS_DISABLED({
while (pi_busy());
cpu_io_write(&PI->PADDR, (uint32_t) (PHYSICAL(address)));
cpu_io_write(&PI->MADDR, (uint32_t) (PHYSICAL(buffer)));
cpu_io_write(&PI->RDMA, length - 1);
});
while (pi_busy());
}