blob: bd6aced87374d01e9eb7e05897d65a744c0c4142 [file] [log] [blame]
wdenk2262cfe2002-11-18 00:14:45 +00001/*
2 * (C) Copyright 2002
3 * Daniel Engström, Omicron Ceti AB, daniel@omicron.se.
wdenk8bde7f72003-06-27 21:31:46 +00004 *
wdenk2262cfe2002-11-18 00:14:45 +00005 * (C) Copyright 2002
6 * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
7 * Marius Groeger <mgroeger@sysgo.de>
8 *
9 * (C) Copyright 2002
10 * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
11 * Alex Zuepke <azu@sysgo.de>
12 *
13 * See file CREDITS for list of people who contributed to this
14 * project.
15 *
16 * This program is free software; you can redistribute it and/or
17 * modify it under the terms of the GNU General Public License as
18 * published by the Free Software Foundation; either version 2 of
19 * the License, or (at your option) any later version.
20 *
21 * This program is distributed in the hope that it will be useful,
22 * but WITHOUT ANY WARRANTY; without even the implied warranty of
23 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
24 * GNU General Public License for more details.
25 *
26 * You should have received a copy of the GNU General Public License
27 * along with this program; if not, write to the Free Software
28 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
29 * MA 02111-1307 USA
30 */
31
32/*
33 * CPU specific code
34 */
35
36#include <common.h>
37#include <command.h>
Graeme Russ3f5f18d2008-12-07 10:29:02 +110038#include <asm/interrupt.h>
wdenk2262cfe2002-11-18 00:14:45 +000039
Graeme Russ1c409bc2009-11-24 20:04:21 +110040int cpu_init_f(void)
wdenk2262cfe2002-11-18 00:14:45 +000041{
wdenk7a8e9bed2003-05-31 18:35:21 +000042 /* initialize FPU, reset EM, set MP and NE */
43 asm ("fninit\n" \
wdenk8bde7f72003-06-27 21:31:46 +000044 "movl %cr0, %eax\n" \
45 "andl $~0x4, %eax\n" \
46 "orl $0x22, %eax\n" \
47 "movl %eax, %cr0\n" );
48
Graeme Russ1c409bc2009-11-24 20:04:21 +110049 return 0;
50}
51
52int cpu_init_r(void)
53{
Graeme Russabf0cd32009-02-24 21:13:40 +110054 /* Initialize core interrupt and exception functionality of CPU */
55 cpu_init_interrupts ();
wdenk2262cfe2002-11-18 00:14:45 +000056 return 0;
57}
58
Wolfgang Denk54841ab2010-06-28 22:00:46 +020059int do_reset(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
wdenk2262cfe2002-11-18 00:14:45 +000060{
wdenk2262cfe2002-11-18 00:14:45 +000061 printf ("resetting ...\n");
62 udelay(50000); /* wait 50 ms */
63 disable_interrupts();
64 reset_cpu(0);
65
66 /*NOTREACHED*/
67 return 0;
68}
69
70void flush_cache (unsigned long dummy1, unsigned long dummy2)
71{
72 asm("wbinvd\n");
73 return;
74}
Graeme Russ3f5f18d2008-12-07 10:29:02 +110075
76void __attribute__ ((regparm(0))) generate_gpf(void);
77
78/* segment 0x70 is an arbitrary segment which does not exist */
79asm(".globl generate_gpf\n"
Graeme Russ0fc1b492009-11-24 20:04:19 +110080 ".hidden generate_gpf\n"
81 ".type generate_gpf, @function\n"
Graeme Russ3f5f18d2008-12-07 10:29:02 +110082 "generate_gpf:\n"
83 "ljmp $0x70, $0x47114711\n");
84
85void __reset_cpu(ulong addr)
86{
87 printf("Resetting using i386 Triple Fault\n");
88 set_vector(13, generate_gpf); /* general protection fault handler */
89 set_vector(8, generate_gpf); /* double fault handler */
90 generate_gpf(); /* start the show */
91}
92void reset_cpu(ulong addr) __attribute__((weak, alias("__reset_cpu")));