1 /* $NetBSD: kloader_machdep.c,v 1.14 2008/04/28 20:23:22 martin Exp $ */
2
3 /*-
4 * Copyright (c) 2001, 2002, 2004 The NetBSD Foundation, Inc.
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
17 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
18 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
20 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 * POSSIBILITY OF SUCH DAMAGE.
27 */
28
29 #include <sys/cdefs.h>
30 __KERNEL_RCSID(0, "$NetBSD: kloader_machdep.c,v 1.14 2008/04/28 20:23:22 martin Exp $");
31
32 #include "debug_kloader.h"
33
34 #include <sys/param.h>
35 #include <sys/systm.h>
36
37 #include <sh3/mmu.h>
38 #include <sh3/mmu_sh3.h>
39 #include <sh3/mmu_sh4.h>
40 #include <sh3/cache.h>
41 #include <sh3/cache_sh3.h>
42 #include <sh3/cache_sh4.h>
43
44 #include <machine/kloader.h>
45
46 /* make gcc believe __attribute__((__noreturn__)) claim */
47 #define KLOADER_NORETURN for (;;) continue
48
49 kloader_jumpfunc_t kloader_hpcsh_jump __attribute__((__noreturn__));
50 kloader_bootfunc_t kloader_hpcsh3_boot __attribute__((__noreturn__));
51 kloader_bootfunc_t kloader_hpcsh4_boot __attribute__((__noreturn__));
52
53 struct kloader_ops kloader_hpcsh_ops = {
54 .jump = kloader_hpcsh_jump,
55 .boot = NULL
56 };
57
58
59 void
kloader_reboot_setup(const char * filename)60 kloader_reboot_setup(const char *filename)
61 {
62
63 kloader_hpcsh_ops.boot = CPU_IS_SH3 ? kloader_hpcsh3_boot
64 : kloader_hpcsh4_boot;
65
66 __kloader_reboot_setup(&kloader_hpcsh_ops, filename);
67 }
68
69 void
kloader_hpcsh_jump(kloader_bootfunc_t func,vaddr_t sp,struct kloader_bootinfo * info,struct kloader_page_tag * tag)70 kloader_hpcsh_jump(kloader_bootfunc_t func, vaddr_t sp,
71 struct kloader_bootinfo *info, struct kloader_page_tag *tag)
72 {
73
74 sh_icache_sync_all(); /* also flushes d-cache */
75
76 __asm volatile(
77 "mov %0, r4;"
78 "mov %1, r5;"
79 "jmp @%2;"
80 " mov %3, sp"
81 : : "r"(info), "r"(tag), "r"(func), "r"(sp));
82
83 /* NOTREACHED */
84 KLOADER_NORETURN;
85 }
86
87 /*
88 * 2nd-stage bootloader. Fetches new kernel out of the page tags
89 * chain and copies it to its intended location in memory. Make sure
90 * this function is position independent and fits into a single page.
91 */
92 #define KLOADER_HPCSH_BOOT(cpu, product) \
93 void \
94 kloader_hpcsh ## cpu ## _boot(struct kloader_bootinfo *kbi, \
95 struct kloader_page_tag *p) \
96 { \
97 int tmp; \
98 \
99 /* Disable interrupts, block exceptions. */ \
100 __asm volatile( \
101 "stc sr, %0;" \
102 "or %1, %0;" \
103 "ldc %0, sr" \
104 : "=r"(tmp) \
105 : "r"(PSL_MD | PSL_BL | PSL_IMASK)); \
106 \
107 /* We run on P1, flush and disable TLB. */ \
108 SH ## cpu ## _TLB_DISABLE; \
109 \
110 do { \
111 uint32_t *dst = (uint32_t *)p->dst; \
112 uint32_t *src = (uint32_t *)p->src; \
113 uint32_t sz = p->sz / sizeof (uint32_t); \
114 while (sz--) \
115 *dst++ = *src++; \
116 } while ((p = (struct kloader_page_tag *)p->next) != 0); \
117 \
118 SH ## product ## _CACHE_FLUSH(); \
119 \
120 /* Jump to the kernel entry point. */ \
121 __asm volatile( \
122 "mov %0, r4;" \
123 "mov %1, r5;" \
124 "jmp @%3;" \
125 " mov %2, r6;" \
126 : : \
127 "r"(kbi->argc), \
128 "r"(kbi->argv), \
129 "r"(&kbi->bootinfo), \
130 "r"(kbi->entry)); \
131 \
132 /* NOTREACHED */ \
133 KLOADER_NORETURN; \
134 }
135
136 #ifdef SH3
137 KLOADER_HPCSH_BOOT(3, 7709A)
138 #endif
139
140 #ifdef SH4
141 KLOADER_HPCSH_BOOT(4, 7750)
142 #endif
143