forked from AbleOS/ableos
130 lines
1.8 KiB
Rust
130 lines
1.8 KiB
Rust
use crate::time::fetch_time;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
fn delay(ms: u64) {
|
|
let mut i = 0;
|
|
while i < ms {
|
|
i += 1;
|
|
}
|
|
}
|
|
|
|
pub const CLOCKS_PER_SEC: u64 = 1000;
|
|
|
|
|
|
|
|
|
|
pub fn bogomips() -> u32 {
|
|
|
|
let mut loops_per_sec:u64 = 1;
|
|
let mut ticks: u64 = 0;
|
|
info!("bogomips: starting");
|
|
|
|
while (loops_per_sec << 1) != 0 {
|
|
ticks = fetch_time() as u64;
|
|
delay(loops_per_sec);
|
|
ticks = fetch_time() as u64 - ticks;
|
|
if ticks >= CLOCKS_PER_SEC {
|
|
loops_per_sec = (loops_per_sec / ticks) * CLOCKS_PER_SEC;
|
|
println!("ok - {}.{} BogoMips\n",
|
|
loops_per_sec/500000,
|
|
(loops_per_sec/5000) % 100
|
|
);
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
println!("bogomips: failed to get a result");
|
|
return 61;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
asm!{
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#ifdef CLASSIC_BOGOMIPS
|
|
/* the original code from the Linux kernel */
|
|
static __inline__ void delay(int loops)
|
|
{
|
|
__asm__(".align 2,0x90\n1:\tdecl %0\n\tjns 1b": :"a" (loops):"ax");
|
|
}
|
|
#endif
|
|
|
|
#ifdef QNX_BOGOMIPS
|
|
/* version for QNX C compiler */
|
|
void delay(int loops);
|
|
#pragma aux delay = \
|
|
"l1:" \
|
|
"dec eax" \
|
|
"jns l1" \
|
|
parm nomemory [eax] modify exact nomemory [eax];
|
|
#endif
|
|
|
|
#ifdef PORTABLE_BOGOMIPS
|
|
/* portable version */
|
|
static void delay(int loops)
|
|
{
|
|
long i;
|
|
for (i = loops; i >= 0 ; i--)
|
|
;
|
|
}
|
|
#endif
|
|
|
|
int
|
|
main(void)
|
|
{
|
|
unsigned long loops_per_sec = 1;
|
|
unsigned long ticks;
|
|
|
|
printf("Calibrating delay loop.. ");
|
|
fflush(stdout);
|
|
|
|
while ((loops_per_sec <<= 1)) {
|
|
ticks = clock();
|
|
delay(loops_per_sec);
|
|
ticks = clock() - ticks;
|
|
if (ticks >= CLOCKS_PER_SEC) {
|
|
loops_per_sec = (loops_per_sec / ticks) * CLOCKS_PER_SEC;
|
|
printf("ok - %lu.%02lu BogoMips\n",
|
|
loops_per_sec/500000,
|
|
(loops_per_sec/5000) % 100
|
|
);
|
|
return 0;
|
|
}
|
|
}
|
|
printf("failed\n");
|
|
return -1;
|
|
}
|
|
|
|
*/ |