systemsw.c revision 1.1 1 1.1 mrg /* $NetBSD: systemsw.c,v 1.1 2017/07/24 08:56:29 mrg Exp $ */
2 1.1 mrg
3 1.1 mrg /*
4 1.1 mrg * Copyright 2000, 2001
5 1.1 mrg * Broadcom Corporation. All rights reserved.
6 1.1 mrg *
7 1.1 mrg * This software is furnished under license and may be used and copied only
8 1.1 mrg * in accordance with the following terms and conditions. Subject to these
9 1.1 mrg * conditions, you may download, copy, install, use, modify and distribute
10 1.1 mrg * modified or unmodified copies of this software in source and/or binary
11 1.1 mrg * form. No title or ownership is transferred hereby.
12 1.1 mrg *
13 1.1 mrg * 1) Any source code used, modified or distributed must reproduce and
14 1.1 mrg * retain this copyright notice and list of conditions as they appear in
15 1.1 mrg * the source file.
16 1.1 mrg *
17 1.1 mrg * 2) No right is granted to use any trade name, trademark, or logo of
18 1.1 mrg * Broadcom Corporation. The "Broadcom Corporation" name may not be
19 1.1 mrg * used to endorse or promote products derived from this software
20 1.1 mrg * without the prior written permission of Broadcom Corporation.
21 1.1 mrg *
22 1.1 mrg * 3) THIS SOFTWARE IS PROVIDED "AS-IS" AND ANY EXPRESS OR IMPLIED
23 1.1 mrg * WARRANTIES, INCLUDING BUT NOT LIMITED TO, ANY IMPLIED WARRANTIES OF
24 1.1 mrg * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE, OR
25 1.1 mrg * NON-INFRINGEMENT ARE DISCLAIMED. IN NO EVENT SHALL BROADCOM BE LIABLE
26 1.1 mrg * FOR ANY DAMAGES WHATSOEVER, AND IN PARTICULAR, BROADCOM SHALL NOT BE
27 1.1 mrg * LIABLE FOR DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
28 1.1 mrg * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
29 1.1 mrg * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
30 1.1 mrg * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
31 1.1 mrg * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
32 1.1 mrg * OR OTHERWISE), EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33 1.1 mrg */
34 1.1 mrg
35 1.1 mrg #include <sys/cdefs.h>
36 1.1 mrg __KERNEL_RCSID(0, "$NetBSD: systemsw.c,v 1.1 2017/07/24 08:56:29 mrg Exp $");
37 1.1 mrg
38 1.1 mrg #include <sys/param.h>
39 1.1 mrg #include <sys/cpu.h>
40 1.1 mrg #include <sys/intr.h>
41 1.1 mrg #include <sys/kernel.h>
42 1.1 mrg #include <sys/systm.h>
43 1.1 mrg
44 1.1 mrg #include <mips/locore.h>
45 1.1 mrg #include <mips/mips3_clock.h>
46 1.1 mrg
47 1.1 mrg #include <sbmips/systemsw.h>
48 1.1 mrg
49 1.1 mrg
50 1.1 mrg /* trivial functions for function switch */
51 1.1 mrg static void clock_init_triv(void *);
52 1.1 mrg static void cpu_intr_triv(int, vaddr_t, uint32_t);
53 1.1 mrg
54 1.1 mrg /* system function switch */
55 1.1 mrg struct systemsw systemsw = {
56 1.1 mrg cpu_intr_triv,
57 1.1 mrg
58 1.1 mrg NULL, /* clock intr arg */
59 1.1 mrg clock_init_triv,
60 1.1 mrg
61 1.1 mrg NULL, /* statclock arg */
62 1.1 mrg NULL, /* s_statclock_init: dflt no-op */
63 1.1 mrg NULL, /* s_statclock_setrate: dflt no-op */
64 1.1 mrg
65 1.1 mrg NULL, /* intr_establish */
66 1.1 mrg };
67 1.1 mrg
68 1.1 mrg bool
69 1.1 mrg system_set_clockfns(void *arg, void (*init)(void *))
70 1.1 mrg {
71 1.1 mrg
72 1.1 mrg if (systemsw.s_clock_init != clock_init_triv)
73 1.1 mrg return true;
74 1.1 mrg systemsw.s_clock_arg = arg;
75 1.1 mrg systemsw.s_clock_init = init;
76 1.1 mrg return false;
77 1.1 mrg }
78 1.1 mrg
79 1.1 mrg static void
80 1.1 mrg cpu_intr_triv(int ppl, vaddr_t pc, uint32_t status)
81 1.1 mrg {
82 1.1 mrg
83 1.1 mrg panic("cpu_intr_triv");
84 1.1 mrg }
85 1.1 mrg
86 1.1 mrg void
87 1.1 mrg cpu_intr(int ppl, vaddr_t pc, uint32_t status)
88 1.1 mrg {
89 1.1 mrg
90 1.1 mrg (*systemsw.s_cpu_intr)(ppl, pc, status);
91 1.1 mrg }
92 1.1 mrg
93 1.1 mrg static void
94 1.1 mrg clock_init_triv(void *arg)
95 1.1 mrg {
96 1.1 mrg
97 1.1 mrg panic("clock_init_triv");
98 1.1 mrg }
99 1.1 mrg
100 1.1 mrg void
101 1.1 mrg cpu_initclocks(void)
102 1.1 mrg {
103 1.1 mrg
104 1.1 mrg (*systemsw.s_clock_init)(systemsw.s_clock_arg);
105 1.1 mrg
106 1.1 mrg if (systemsw.s_statclock_init != NULL)
107 1.1 mrg (*systemsw.s_statclock_init)(systemsw.s_statclock_arg);
108 1.1 mrg
109 1.1 mrg /*
110 1.1 mrg * ``Disable'' the compare interrupt by setting it to its largest
111 1.1 mrg * value. Each hard clock interrupt we'll reset the CP0 compare
112 1.1 mrg * register to just bind the CP0 clock register.
113 1.1 mrg */
114 1.1 mrg mips3_cp0_compare_write(~0u);
115 1.1 mrg mips3_cp0_count_write(0);
116 1.1 mrg
117 1.1 mrg mips3_init_tc();
118 1.1 mrg
119 1.1 mrg /*
120 1.1 mrg * Now we can enable all interrupts including hardclock(9).
121 1.1 mrg */
122 1.1 mrg spl0();
123 1.1 mrg }
124 1.1 mrg
125 1.1 mrg void
126 1.1 mrg setstatclockrate(int hzrate)
127 1.1 mrg {
128 1.1 mrg
129 1.1 mrg if (systemsw.s_statclock_setrate != NULL)
130 1.1 mrg (*systemsw.s_statclock_setrate)(systemsw.s_statclock_arg,
131 1.1 mrg hzrate);
132 1.1 mrg }
133