blob: 9f496906d223fa072c8c020838dc7a447f668da6 [file] [log] [blame]
Igor Lisitsina11e0692007-03-28 19:06:19 +04001/*
Sergei Poselenovb4489622007-07-05 08:17:37 +02002 * (C) Copyright 2007
3 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
4 *
5 * Author: Sergei Poselenov <sposelenov@emcraft.com>
Igor Lisitsina11e0692007-03-28 19:06:19 +04006 *
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
Igor Lisitsina11e0692007-03-28 19:06:19 +040028#if defined(CONFIG_440EP) || \
29 defined(CONFIG_440EPX)
30
Igor Lisitsina11e0692007-03-28 19:06:19 +040031#include <asm/processor.h>
Stefan Roeseb36df562010-09-09 19:18:00 +020032#include <asm/ppc4xx.h>
Igor Lisitsina11e0692007-03-28 19:06:19 +040033
34
35int fpu_status(void)
36{
Matthias Fuchs58ea1422009-07-22 17:27:56 +020037 if (mfspr(SPRN_CCR0) & CCR0_DAPUIB)
Igor Lisitsina11e0692007-03-28 19:06:19 +040038 return 0; /* Disabled */
Wolfgang Denk4ef218f2007-07-10 00:01:28 +020039 else
Igor Lisitsina11e0692007-03-28 19:06:19 +040040 return 1; /* Enabled */
41}
42
43
44void fpu_disable(void)
45{
Matthias Fuchs58ea1422009-07-22 17:27:56 +020046 mtspr(SPRN_CCR0, mfspr(SPRN_CCR0) | CCR0_DAPUIB);
Igor Lisitsina11e0692007-03-28 19:06:19 +040047 mtmsr(mfmsr() & ~MSR_FP);
48}
49
50
51void fpu_enable(void)
52{
Matthias Fuchs58ea1422009-07-22 17:27:56 +020053 mtspr(SPRN_CCR0, mfspr(SPRN_CCR0) & ~CCR0_DAPUIB);
Igor Lisitsina11e0692007-03-28 19:06:19 +040054 mtmsr(mfmsr() | MSR_FP);
55}
Sergei Poselenovb4489622007-07-05 08:17:37 +020056
Igor Lisitsina11e0692007-03-28 19:06:19 +040057#endif