Move cpu_reset to be a platform method to allow multiple implementations.
[freebsd.git] / sys / arm / nvidia / tegra124 / tegra124_machdep.c
1 /*-
2  * Copyright (c) 2016 Michal Meloun <mmel@FreeBSD.org>
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer.
10  * 2. Redistributions in binary form must reproduce the above copyright
11  *    notice, this list of conditions and the following disclaimer in the
12  *    documentation and/or other materials provided with the distribution.
13  *
14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24  * SUCH DAMAGE.
25  */
26
27 #include "opt_platform.h"
28
29 #include <sys/cdefs.h>
30 __FBSDID("$FreeBSD$");
31
32 #include <sys/param.h>
33 #include <sys/systm.h>
34 #include <sys/bus.h>
35 #include <sys/reboot.h>
36 #include <sys/devmap.h>
37
38 #include <vm/vm.h>
39
40 #include <machine/bus.h>
41 #include <machine/fdt.h>
42 #include <machine/intr.h>
43 #include <machine/machdep.h>
44 #include <machine/platformvar.h>
45
46 #include <dev/fdt/fdt_common.h>
47 #include <dev/ofw/openfirm.h>
48
49 #include <arm/nvidia/tegra124/tegra124_mp.h>
50
51 #include "platform_if.h"
52
53 #define PMC_PHYSBASE            0x7000e400
54 #define PMC_SIZE                0x400
55 #define PMC_CONTROL_REG         0x0
56 #define PMC_SCRATCH0            0x50
57 #define  PMC_SCRATCH0_MODE_RECOVERY     (1 << 31)
58 #define  PMC_SCRATCH0_MODE_BOOTLOADER   (1 << 30)
59 #define  PMC_SCRATCH0_MODE_RCM          (1 << 1)
60 #define  PMC_SCRATCH0_MODE_MASK         (PMC_SCRATCH0_MODE_RECOVERY | \
61                                         PMC_SCRATCH0_MODE_BOOTLOADER | \
62                                         PMC_SCRATCH0_MODE_RCM)
63
64 struct fdt_fixup_entry fdt_fixup_table[] = {
65         { NULL, NULL }
66 };
67
68 static vm_offset_t
69 tegra124_lastaddr(platform_t plat)
70 {
71
72         return (devmap_lastaddr());
73 }
74
75 static int
76 tegra124_attach(platform_t plat)
77 {
78
79         return (0);
80 }
81
82 static void
83 tegra124_late_init(platform_t plat)
84 {
85
86 }
87
88 /*
89  * Set up static device mappings.
90  *
91  */
92 static int
93 tegra124_devmap_init(platform_t plat)
94 {
95
96         devmap_add_entry(0x70000000, 0x01000000);
97         return (0);
98 }
99
100 static void
101 tegra124_cpu_reset(platform_t plat)
102 {
103         bus_space_handle_t pmc;
104         uint32_t reg;
105
106         printf("Resetting...\n");
107         bus_space_map(fdtbus_bs_tag, PMC_PHYSBASE, PMC_SIZE, 0, &pmc);
108
109         reg = bus_space_read_4(fdtbus_bs_tag, pmc, PMC_SCRATCH0);
110         reg &= PMC_SCRATCH0_MODE_MASK;
111         bus_space_write_4(fdtbus_bs_tag, pmc, PMC_SCRATCH0,
112            reg | PMC_SCRATCH0_MODE_BOOTLOADER);         /* boot to bootloader */
113         bus_space_read_4(fdtbus_bs_tag, pmc, PMC_SCRATCH0);
114
115         reg = bus_space_read_4(fdtbus_bs_tag, pmc, PMC_CONTROL_REG);
116         spinlock_enter();
117         dsb();
118         bus_space_write_4(fdtbus_bs_tag, pmc, PMC_CONTROL_REG, reg | 0x10);
119         bus_space_read_4(fdtbus_bs_tag, pmc, PMC_CONTROL_REG);
120         while(1)
121                 ;
122
123 }
124
125 /*
126  * Early putc routine for EARLY_PRINTF support.  To use, add to kernel config:
127  *   option SOCDEV_PA=0x02000000
128  *   option SOCDEV_VA=0x02000000
129  *   option EARLY_PRINTF
130  */
131 #if 0
132 static void
133 tegra124_early_putc(int c)
134 {
135         volatile uint32_t * UART_STAT_REG = (uint32_t *)0x02020098;
136         volatile uint32_t * UART_TX_REG   = (uint32_t *)0x02020040;
137         const uint32_t      UART_TXRDY    = (1 << 3);
138
139         while ((*UART_STAT_REG & UART_TXRDY) == 0)
140                 continue;
141         *UART_TX_REG = c;
142 }
143 early_putc_t *early_putc = tegra124_early_putc;
144 #endif
145
146 static platform_method_t tegra124_methods[] = {
147         PLATFORMMETHOD(platform_attach,         tegra124_attach),
148         PLATFORMMETHOD(platform_lastaddr,       tegra124_lastaddr),
149         PLATFORMMETHOD(platform_devmap_init,    tegra124_devmap_init),
150         PLATFORMMETHOD(platform_late_init,      tegra124_late_init),
151         PLATFORMMETHOD(platform_cpu_reset,      tegra124_cpu_reset),
152
153 #ifdef SMP
154         PLATFORMMETHOD(platform_mp_start_ap,    tegra124_mp_start_ap),
155         PLATFORMMETHOD(platform_mp_setmaxid,    tegra124_mp_setmaxid),
156 #endif
157         PLATFORMMETHOD_END,
158 };
159
160 FDT_PLATFORM_DEF(tegra124, "Nvidia Jetson-TK1", 0, "nvidia,jetson-tk1", 0);