mirror of
https://github.com/cirosantilli/linux-kernel-module-cheat.git
synced 2026-01-23 10:15:57 +01:00
60 lines
1.7 KiB
C
60 lines
1.7 KiB
C
#include <stdio.h>
|
|
#include <inttypes.h>
|
|
|
|
#include <lkmc.h>
|
|
#include <lkmc/gicv3.h>
|
|
|
|
#define CNTV_CTL_ENABLE (1 << 0)
|
|
#define CNTV_CTL_IMASK (1 << 1)
|
|
#define CNTV_CTL_ISTATUS (1 << 2)
|
|
|
|
void cntv_ctl_el0_disable(void) {
|
|
lkmc_sysreg_cntv_ctl_el0_write(lkmc_sysreg_cntv_ctl_el0_read() & ~CNTV_CTL_ENABLE);
|
|
}
|
|
|
|
/* If enabled, when: cntv_ctl > cntv_cval then:
|
|
*
|
|
* * if CNTV_CTL_IMASK is clear, raise an interrupt
|
|
* * set CNTV_CTL_ISTATUS
|
|
*/
|
|
void cntv_ctl_el0_enable(void) {
|
|
lkmc_sysreg_cntv_ctl_el0_write(lkmc_sysreg_cntv_ctl_el0_read() | CNTV_CTL_ENABLE);
|
|
}
|
|
|
|
|
|
void lkmc_vector_trap_handler(LkmcVectorExceptionFrame *exception __attribute__((unused))) {
|
|
}
|
|
|
|
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());
|
|
|
|
/* 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());
|
|
|
|
/*gic_v3_initialize();*/
|
|
{
|
|
/*uint64_t ticks, current_cnt;*/
|
|
/*uint32_t cntfrq;*/
|
|
/*cntfrq = raw_read_cntfrq_el0();*/
|
|
/*ticks = cntfrq;*/
|
|
/*current_cnt = raw_read_cntvct_el0();*/
|
|
/*raw_write_cntv_cval_el0(current_cnt + ticks);*/
|
|
/*enable_cntv();*/
|
|
/*enable_irq();*/
|
|
}
|
|
|
|
#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
|
|
|
|
return 0;
|
|
}
|