3rd-party/linux-kernel-module-cheat
1
0
Fork 0
mirror of https://github.com/cirosantilli/linux-kernel-module-cheat.git synced 2026-01-23 02:05:57 +01:00
Code Issues Releases Wiki Activity

arm gic: get closer to working, still failing though

Browse Source 
Define print functions for all system regs.
This commit is contained in:
Ciro Santilli 六四事件 法轮功
2019-07-31 00:00:00 +00:00
parent 3b93a2d65a
commit 75e2582970
6 changed files with 229 additions and 107 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
baremetal/arch/aarch64/svc.c
View File

@@ -64,9 +64,9 @@ void lkmc_vector_trap_handler(LkmcVectorExceptionFrame *exception) {
int main(void) {
/* View initial relevant register values. */
printf("DAIF 0x%" PRIX32 "\n", lkmc_sysreg_daif_read());
printf("SPSEL 0x%" PRIX32 "\n", lkmc_sysreg_spsel_read());
printf("VBAR_EL1 0x%" PRIX64 "\n", lkmc_sysreg_vbar_el1_read());
lkmc_sysreg_print_daif();
lkmc_sysreg_print_spsel();
lkmc_sysreg_print_vbar_el1();
/* https://stackoverflow.com/questions/1777990/is-it-possible-to-store-the-address-of-a-label-in-a-variable-and-use-goto-to-jum */
printf("&after_svc %p\n", &&after_svc);
assert(myvar == 0);

103
baremetal/arch/aarch64/timer.c
View File

@@ -4,63 +4,84 @@
#include <lkmc.h>
#include <lkmc/gicv3.h>
void lkmc_vector_trap_handler(LkmcVectorExceptionFrame *exception __attribute__((unused))) {
printf("CNTVCT_EL0 0x%" PRIX64 "\n", lkmc_sysreg_cntvct_el0_read());
}
/* DAIF, Interrupt Mask Bits */
#define DAIF_DBG_BIT (1<<3) /* Debug mask bit */
#define DAIF_ABT_BIT (1<<2) /* Asynchronous abort mask bit */
#define DAIF_IRQ_BIT (1<<1) /* IRQ mask bit */
#define DAIF_FIQ_BIT (1<<0) /* FIQ mask bit */
#define wfi() __asm__ __volatile__ ("wfi" : : : "memory")
void enable_cntv(void) {
lkmc_sysreg_cntv_ctl_el0_write(lkmc_sysreg_cntv_ctl_el0_read() | LKMC_CNTV_CTL_ENABLE);
}
#define IRQ_FOUND (0)
#define IRQ_NOT_FOUND (1)
void enable_irq(void) {
__asm__ __volatile__ ("msr DAIFClr, %0" : : "i" (DAIF_IRQ_BIT) : "memory");
__asm__ __volatile__("msr DAIFClr, %0\n\t" : : "i" (LKMC_SYSREG_BITS_DAIF_IRQ) : "memory");
}
void disable_irq(void) {
__asm__ __volatile__("msr DAIFSet, %0\n\t" : : "i" (LKMC_SYSREG_BITS_DAIF_IRQ) : "memory");
}
/* Processor status word. */
void psw_disable_and_save_interrupt(uint64_t *pswp) {
uint64_t psw;
psw = lkmc_sysreg_read_daif();
disable_irq();
*pswp = psw;
}
/* Processor status word. */
void psw_restore_interrupt(uint64_t *pswp) {
uint64_t psw;
psw = *pswp;
lkmc_sysreg_write_daif(psw);
}
void lkmc_vector_trap_handler(
LkmcVectorExceptionFrame *exception __attribute__((unused))
) {
uint64_t psw;
irq_no irq;
int rc;
if ((exception->exc_type & 0xff) == LKMC_VECTOR_IRQ_SPX) {
psw_disable_and_save_interrupt(&psw);
rc = gic_v3_find_pending_irq(exception, &irq);
if (rc != IRQ_FOUND) {
puts("IRQ not found!");
goto restore_irq_out;
} else {
printf("IRQ found: 0x%" PRIX32 "\n", irq);
}
gicd_disable_int(irq);
gic_v3_eoi(irq);
printf("CNTVCT_EL0 0x%" PRIX64 "\n", lkmc_sysreg_read_cntvct_el0());
gicd_enable_int(irq);
restore_irq_out:
psw_restore_interrupt(&psw);
}
}
void enable_cntv(void) {
lkmc_sysreg_write_cntv_ctl_el0(lkmc_sysreg_read_cntv_ctl_el0() | LKMC_CNTV_CTL_ENABLE);
}
int main(void) {
/* Initial state. */
printf("CNTV_CTL_EL0 0x%" PRIX32 "\n", lkmc_sysreg_cntv_ctl_el0_read());
printf("CNTFRQ_EL0 0x%" PRIX64 "\n", lkmc_sysreg_cntfrq_el0_read());
printf("CNTV_CVAL_EL0 0x%" PRIX64 "\n", lkmc_sysreg_cntv_cval_el0_read());
lkmc_sysreg_print_cntv_ctl_el0();
lkmc_sysreg_print_cntfrq_el0();
lkmc_sysreg_print_cntv_cval_el0();
/* Get the counter value many times to watch the time pass. */
printf("CNTVCT_EL0 0x%" PRIX64 "\n", lkmc_sysreg_cntvct_el0_read());
printf("CNTVCT_EL0 0x%" PRIX64 "\n", lkmc_sysreg_cntvct_el0_read());
printf("CNTVCT_EL0 0x%" PRIX64 "\n", lkmc_sysreg_cntvct_el0_read());
lkmc_sysreg_print_cntvct_el0();
lkmc_sysreg_print_cntvct_el0();
lkmc_sysreg_print_cntvct_el0();
/**/
gic_v3_initialize();
{
/*uint64_t ticks, current_cnt;*/
/*uint32_t cntfrq;*/
lkmc_sysreg_cntfrq_el0_write(1);
lkmc_sysreg_write_cntfrq_el0(1);
/*ticks = cntfrq;*/
/*current_cnt = lkmc_sysreg_cntvct_el0_read();*/
/*lkmc_sysreg_cntv_cval_el0_write(current_cnt + ticks);*/
/*current_cnt = lkmc_sysreg_read_cntvct_el0();*/
/*lkmc_sysreg_write_cntv_cval_el0(current_cnt + ticks);*/
enable_cntv();
enable_irq();
}
/*while (1) {*/
/*puts("qwer");*/
/*current_cnt = raw_read_cntvct_el0();*/
/*val = raw_read_cntv_ctl();*/
/*printf("CNTVCT_EL0 = ");*/
/*wfi();*/
/*}*/
#if 0
/* TODO crashes gem5. */
puts("cntfrq_el0 = 1");
lkmc_sysreg_cntfrq_el0_write(1);
printf("cntfrq_el0 0x%" PRIX64 "\n", lkmc_sysreg_cntfrq_el0_read());
#endif
while (1) {
LKMC_WFI;
}
return 0;
}