]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/arm/altera/socfpga/socfpga_common.c
ARM: SEV/WFE instructions are implemented starting from ARMv6K,
[FreeBSD/FreeBSD.git] / sys / arm / altera / socfpga / socfpga_common.c
1 /*-
2  * Copyright (c) 2014 Ruslan Bukin <br@bsdpad.com>
3  * All rights reserved.
4  *
5  * This software was developed by SRI International and the University of
6  * Cambridge Computer Laboratory under DARPA/AFRL contract (FA8750-10-C-0237)
7  * ("CTSRD"), as part of the DARPA CRASH research programme.
8  *
9  * Redistribution and use in source and binary forms, with or without
10  * modification, are permitted provided that the following conditions
11  * are met:
12  * 1. Redistributions of source code must retain the above copyright
13  *    notice, this list of conditions and the following disclaimer.
14  * 2. Redistributions in binary form must reproduce the above copyright
15  *    notice, this list of conditions and the following disclaimer in the
16  *    documentation and/or other materials provided with the distribution.
17  *
18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
19  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
22  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28  * SUCH DAMAGE.
29  */
30
31 #include <sys/cdefs.h>
32 __FBSDID("$FreeBSD$");
33
34 #include <sys/param.h>
35 #include <sys/systm.h>
36 #include <sys/bus.h>
37 #include <sys/kernel.h>
38
39 #include <dev/fdt/fdt_common.h>
40 #include <dev/ofw/openfirm.h>
41
42 #include <machine/bus.h>
43 #include <machine/fdt.h>
44
45 #include <arm/altera/socfpga/socfpga_rstmgr.h>
46
47 void
48 cpu_reset(void)
49 {
50         uint32_t addr, paddr;
51         bus_addr_t vaddr;
52         phandle_t node;
53
54         if (rstmgr_warmreset() == 0)
55                 goto end;
56
57         node = OF_finddevice("rstmgr");
58         if (node == -1)
59                 goto end;
60
61         if ((OF_getprop(node, "reg", &paddr, sizeof(paddr))) > 0) {
62                 addr = fdt32_to_cpu(paddr);
63                 if (bus_space_map(fdtbus_bs_tag, addr, 0x8, 0, &vaddr) == 0) {
64                         bus_space_write_4(fdtbus_bs_tag, vaddr,
65                             RSTMGR_CTRL, CTRL_SWWARMRSTREQ);
66                 }
67         }
68
69 end:
70         while (1);
71 }
72
73 #ifndef INTRNG
74 static int
75 fdt_pic_decode_ic(phandle_t node, pcell_t *intr, int *interrupt, int *trig,
76     int *pol)
77 {
78
79         if (!fdt_is_compatible(node, "arm,gic"))
80                 return (ENXIO);
81
82         *interrupt = fdt32_to_cpu(intr[0]);
83         *trig = INTR_TRIGGER_CONFORM;
84         *pol = INTR_POLARITY_CONFORM;
85         return (0);
86 }
87
88 fdt_pic_decode_t fdt_pic_table[] = {
89         &fdt_pic_decode_ic,
90         NULL
91 };
92 #endif