]>
Commit | Line | Data |
---|---|---|
a11e0696 | 1 | /* |
b4489621 SP |
2 | * (C) Copyright 2007 |
3 | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. | |
4 | * | |
5 | * Author: Sergei Poselenov <sposelenov@emcraft.com> | |
a11e0696 IL |
6 | * |
7 | * See file CREDITS for list of people who contributed to this | |
8 | * project. | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or | |
11 | * modify it under the terms of the GNU General Public License as | |
12 | * published by the Free Software Foundation; either version 2 of | |
13 | * the License, or (at your option) any later version. | |
14 | * | |
15 | * This program is distributed in the hope that it will be useful, | |
16 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
18 | * GNU General Public License for more details. | |
19 | * | |
20 | * You should have received a copy of the GNU General Public License | |
21 | * along with this program; if not, write to the Free Software | |
22 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, | |
23 | * MA 02111-1307 USA | |
24 | */ | |
25 | ||
26 | #include <config.h> | |
27 | ||
28 | #ifdef CONFIG_POST | |
29 | #if defined(CONFIG_440EP) || \ | |
30 | defined(CONFIG_440EPX) | |
31 | ||
32 | #include <ppc4xx.h> | |
33 | #include <asm/processor.h> | |
34 | ||
35 | ||
36 | int fpu_status(void) | |
37 | { | |
38 | if (mfspr(ccr0) & CCR0_DAPUIB) | |
39 | return 0; /* Disabled */ | |
b4489621 | 40 | else |
a11e0696 IL |
41 | return 1; /* Enabled */ |
42 | } | |
43 | ||
44 | ||
45 | void fpu_disable(void) | |
46 | { | |
47 | mtspr(ccr0, mfspr(ccr0) | CCR0_DAPUIB); | |
48 | mtmsr(mfmsr() & ~MSR_FP); | |
49 | } | |
50 | ||
51 | ||
52 | void fpu_enable(void) | |
53 | { | |
54 | mtspr(ccr0, mfspr(ccr0) & ~CCR0_DAPUIB); | |
55 | mtmsr(mfmsr() | MSR_FP); | |
56 | } | |
b4489621 | 57 | |
a11e0696 | 58 | #endif |
b4489621 | 59 | #endif /* CONFIG_POST */ |