blob: fff4169976ea0ec9e72622719a07f12f64fb23ae [file] [log] [blame]
Igor Lisitsin95bcd382007-03-28 19:06:19 +04001/*
Sergei Poselenov3190dbe2007-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 Lisitsin95bcd382007-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 Lisitsin95bcd382007-03-28 19:06:19 +040028#if defined(CONFIG_440EP) || \
29 defined(CONFIG_440EPX)
30
Igor Lisitsin95bcd382007-03-28 19:06:19 +040031#include <asm/processor.h>
Stefan Roese0dd0e642007-07-31 08:37:01 +020032#include <ppc4xx.h>
Igor Lisitsin95bcd382007-03-28 19:06:19 +040033
34
35int fpu_status(void)
36{
37 if (mfspr(ccr0) & CCR0_DAPUIB)
38 return 0; /* Disabled */
Wolfgang Denka0453aa2007-07-10 00:01:28 +020039 else
Igor Lisitsin95bcd382007-03-28 19:06:19 +040040 return 1; /* Enabled */
41}
42
43
44void fpu_disable(void)
45{
46 mtspr(ccr0, mfspr(ccr0) | CCR0_DAPUIB);
47 mtmsr(mfmsr() & ~MSR_FP);
48}
49
50
51void fpu_enable(void)
52{
53 mtspr(ccr0, mfspr(ccr0) & ~CCR0_DAPUIB);
54 mtmsr(mfmsr() | MSR_FP);
55}
Sergei Poselenov3190dbe2007-07-05 08:17:37 +020056
Igor Lisitsin95bcd382007-03-28 19:06:19 +040057#endif