2011-03-30 01:35:02 +04:00
|
|
|
/*
|
2011-04-15 05:49:36 +04:00
|
|
|
* Tiny FPU enable module.
|
|
|
|
*
|
|
|
|
* Part of the ToAruOS Kernel
|
|
|
|
* (C) 2011 Kevin Lange ...
|
|
|
|
* To whatever possible level this short of a code chunk
|
|
|
|
* can be considered copyrightable in your jurisdiction.
|
2011-03-30 01:35:02 +04:00
|
|
|
*/
|
|
|
|
#include <system.h>
|
|
|
|
|
2011-04-15 05:49:36 +04:00
|
|
|
/**
|
|
|
|
* Set the FPU control word
|
|
|
|
*
|
|
|
|
* @param cw What to set the control word to.
|
|
|
|
*/
|
2011-03-30 01:35:02 +04:00
|
|
|
void
|
|
|
|
set_fpu_cw(const uint16_t cw) {
|
2011-10-31 10:17:26 +04:00
|
|
|
asm volatile("fldcw %0" :: "m"(cw));
|
2011-03-30 01:35:02 +04:00
|
|
|
}
|
|
|
|
|
2011-04-15 05:49:36 +04:00
|
|
|
/**
|
|
|
|
* Enable the FPU
|
|
|
|
*
|
|
|
|
* We are assuming that we have one to begin with, but since we
|
|
|
|
* only really operate on 686 machines, we do, so we're not
|
|
|
|
* going to bother checking.
|
|
|
|
*/
|
2011-03-30 01:35:02 +04:00
|
|
|
void
|
|
|
|
enable_fpu() {
|
|
|
|
size_t cr4;
|
2011-10-31 10:17:26 +04:00
|
|
|
asm volatile ("mov %%cr4, %0" : "=r"(cr4));
|
2011-03-30 01:35:02 +04:00
|
|
|
cr4 |= 0x200;
|
2011-10-31 10:17:26 +04:00
|
|
|
asm volatile ("mov %0, %%cr4" :: "r"(cr4));
|
2011-03-30 01:35:02 +04:00
|
|
|
set_fpu_cw(0x37F);
|
|
|
|
}
|
2011-04-15 05:49:36 +04:00
|
|
|
|
|
|
|
/*
|
|
|
|
* vim:tabstop=4
|
|
|
|
* vim:noexpandtab
|
|
|
|
*/
|