kernel: Make SMP support default (and non-optional).
[dragonfly.git] / sys / platform / pc32 / isa / prof_machdep.c
1 /*-
2  * Copyright (c) 1996 Bruce D. Evans.
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  * $FreeBSD: src/sys/i386/isa/prof_machdep.c,v 1.14.2.1 2000/08/03 00:09:30 ps Exp $
27  */
28
29 #ifdef GUPROF
30 #include "opt_i586_guprof.h"
31 #include "opt_perfmon.h"
32
33 #include <sys/param.h>
34 #include <sys/systm.h>
35 #include <sys/gmon.h>
36 #include <sys/kernel.h>
37 #include <sys/sysctl.h>
38
39 #include <machine/clock.h>
40 #include <machine/perfmon.h>
41 #include <machine/profile.h>
42 #undef MCOUNT
43 #endif
44
45 #include <machine/asmacros.h>
46
47 #include <bus/isa/isa.h>
48 #include <machine_base/isa/timerreg.h>
49
50 #ifdef GUPROF
51 #define CPUTIME_CLOCK_UNINITIALIZED     0
52 #define CPUTIME_CLOCK_I8254             1
53 #define CPUTIME_CLOCK_TSC               2
54 #define CPUTIME_CLOCK_I586_PMC          3
55 #define CPUTIME_CLOCK_I8254_SHIFT       7
56
57 int     cputime_bias = 1;       /* initialize for locality of reference */
58
59 static int      cputime_clock = CPUTIME_CLOCK_UNINITIALIZED;
60 #ifdef I586_PMC_GUPROF
61 static u_int    cputime_clock_pmc_conf = I586_PMC_GUPROF;
62 static int      cputime_clock_pmc_init;
63 static struct gmonparam saved_gmp;
64 #endif
65 #endif /* GUPROF */
66
67 #ifdef __GNUC__
68 __asm("                                                         \n\
69 GM_STATE        =       0                                       \n\
70 GMON_PROF_OFF   =       3                                       \n\
71                                                                 \n\
72         .text                                                   \n\
73         .p2align 4,0x90                                         \n\
74         .globl  __mcount                                        \n\
75         .type   __mcount,@function                              \n\
76 __mcount:                                                       \n\
77         #                                                       \n\
78         # Check that we are profiling.  Do it early for speed.  \n\
79         #                                                       \n\
80         cmpl    $GMON_PROF_OFF," __XSTRING(CNAME(_gmonparam)) "+GM_STATE \n\
81         je      .mcount_exit                                    \n\
82         #                                                       \n\
83         # __mcount is the same as [.]mcount except the caller   \n\
84         # hasn't changed the stack except to call here, so the  \n\
85         # caller's raddr is above our raddr.                    \n\
86         #                                                       \n\
87         pushl   %eax                                            \n\
88         pushl   %ecx                                            \n\
89         pushl   %edx                                            \n\
90         movl    12+4(%esp),%edx                                 \n\
91         jmp     .got_frompc                                     \n\
92                                                                 \n\
93         .p2align 4,0x90                                         \n\
94         .globl  " __XSTRING(HIDENAME(mcount)) "                 \n\
95 " __XSTRING(HIDENAME(mcount)) ":                                \n\
96         cmpl    $GMON_PROF_OFF," __XSTRING(CNAME(_gmonparam)) "+GM_STATE \n\
97         je      .mcount_exit                                    \n\
98         #                                                       \n\
99         # The caller's stack frame has already been built, so   \n\
100         # %ebp is the caller's frame pointer.  The caller's     \n\
101         # raddr is in the caller's frame following the caller's \n\
102         # caller's frame pointer.                               \n\
103         #                                                       \n\
104         pushl   %eax                                            \n\
105         pushl   %ecx                                            \n\
106         pushl   %edx                                            \n\
107         movl    4(%ebp),%edx                                    \n\
108 .got_frompc:                                                    \n\
109         #                                                       \n\
110         # Our raddr is the caller's pc.                         \n\
111         #                                                       \n\
112         movl    (%esp),%eax                                     \n\
113                                                                 \n\
114         pushfl                                                  \n\
115         pushl   %eax                                            \n\
116         pushl   %edx                                            \n\
117         cli                                                     \n\
118         call    " __XSTRING(CNAME(mcount)) "                    \n\
119         addl    $8,%esp                                         \n\
120         popfl                                                   \n\
121         popl    %edx                                            \n\
122         popl    %ecx                                            \n\
123         popl    %eax                                            \n\
124 .mcount_exit:                                                   \n\
125         ret                                                     \n\
126 ");
127 #else /* !__GNUC__ */
128 #error
129 #endif /* __GNUC__ */
130
131 #ifdef GUPROF
132 /*
133  * [.]mexitcount saves the return register(s), loads selfpc and calls
134  * mexitcount(selfpc) to do the work.  Someday it should be in a machine
135  * dependent file together with cputime(), __mcount and [.]mcount.  cputime()
136  * can't just be put in machdep.c because it has to be compiled without -pg.
137  */
138 #ifdef __GNUC__
139 __asm("                                                         \n\
140         .text                                                   \n\
141 #                                                               \n\
142 # Dummy label to be seen when gprof -u hides [.]mexitcount.     \n\
143 #                                                               \n\
144         .p2align 4,0x90                                         \n\
145         .globl  __mexitcount                                    \n\
146         .type   __mexitcount,@function                          \n\
147 __mexitcount:                                                   \n\
148         nop                                                     \n\
149                                                                 \n\
150 GMON_PROF_HIRES =       4                                       \n\
151                                                                 \n\
152         .p2align 4,0x90                                         \n\
153         .globl  " __XSTRING(HIDENAME(mexitcount)) "             \n\
154 " __XSTRING(HIDENAME(mexitcount)) ":                            \n\
155         cmpl    $GMON_PROF_HIRES," __XSTRING(CNAME(_gmonparam)) "+GM_STATE \n\
156         jne     .mexitcount_exit                                \n\
157         pushl   %edx                                            \n\
158         pushl   %ecx                                            \n\
159         pushl   %eax                                            \n\
160         movl    12(%esp),%eax                                   \n\
161         pushfl                                                  \n\
162         pushl   %eax                                            \n\
163         cli                                                     \n\
164         call    " __XSTRING(CNAME(mexitcount)) "                \n\
165         addl    $4,%esp                                         \n\
166         popfl                                                   \n\
167         popl    %eax                                            \n\
168         popl    %ecx                                            \n\
169         popl    %edx                                            \n\
170 .mexitcount_exit:                                               \n\
171         ret                                                     \n\
172 ");
173 #else /* !__GNUC__ */
174 #error
175 #endif /* __GNUC__ */
176
177 /*
178  * Return the time elapsed since the last call.  The units are machine-
179  * dependent.
180  */
181 int
182 cputime(void)
183 {
184         u_int count;
185         int delta;
186         u_char high, low;
187         static u_int prev_count;
188
189         /*
190          * Read the current value of the 8254 timer counter 0.
191          */
192         outb(TIMER_MODE, TIMER_SEL0 | TIMER_LATCH);
193         low = inb(TIMER_CNTR0);
194         high = inb(TIMER_CNTR0);
195         count = ((high << 8) | low) << CPUTIME_CLOCK_I8254_SHIFT;
196
197         /*
198          * The timer counts down from TIMER_CNTR0_MAX to 0 and then resets.
199          * While profiling is enabled, this routine is called at least twice
200          * per timer reset (for mcounting and mexitcounting hardclock()),
201          * so at most one reset has occurred since the last call, and one
202          * has occurred iff the current count is larger than the previous
203          * count.  This allows counter underflow to be detected faster
204          * than in microtime().
205          */
206         delta = prev_count - count;
207         prev_count = count;
208         if (delta <= 0)
209                 return (delta + (timer0_max_count << CPUTIME_CLOCK_I8254_SHIFT));
210         return (delta);
211 }
212
213 static int
214 sysctl_machdep_cputime_clock(SYSCTL_HANDLER_ARGS)
215 {
216         int clock;
217         int error;
218 #if defined(PERFMON) && defined(I586_PMC_GUPROF)
219         int event;
220         struct pmc pmc;
221 #endif
222
223         clock = cputime_clock;
224 #if defined(PERFMON) && defined(I586_PMC_GUPROF)
225         if (clock == CPUTIME_CLOCK_I586_PMC) {
226                 pmc.pmc_val = cputime_clock_pmc_conf;
227                 clock += pmc.pmc_event;
228         }
229 #endif
230         error = sysctl_handle_opaque(oidp, &clock, sizeof clock, req);
231         if (error == 0 && req->newptr != NULL) {
232 #if defined(PERFMON) && defined(I586_PMC_GUPROF)
233                 if (clock >= CPUTIME_CLOCK_I586_PMC) {
234                         event = clock - CPUTIME_CLOCK_I586_PMC;
235                         if (event >= 256)
236                                 return (EINVAL);
237                         pmc.pmc_num = 0;
238                         pmc.pmc_event = event;
239                         pmc.pmc_unit = 0;
240                         pmc.pmc_flags = PMCF_E | PMCF_OS | PMCF_USR;
241                         pmc.pmc_mask = 0;
242                         cputime_clock_pmc_conf = pmc.pmc_val;
243                         cputime_clock = CPUTIME_CLOCK_I586_PMC;
244                 } else
245 #endif
246                 {
247                         if (clock < 0 || clock >= CPUTIME_CLOCK_I586_PMC)
248                                 return (EINVAL);
249                         cputime_clock = clock;
250                 }
251         }
252         return (error);
253 }
254
255 SYSCTL_PROC(_machdep, OID_AUTO, cputime_clock, CTLTYPE_INT | CTLFLAG_RW,
256             0, sizeof(u_int), sysctl_machdep_cputime_clock, "I", "");
257
258 /*
259  * The start and stop routines need not be here since we turn off profiling
260  * before calling them.  They are here for convenience.
261  */
262
263 void
264 startguprof(struct gmonparam *gp)
265 {
266         if (cputime_clock == CPUTIME_CLOCK_UNINITIALIZED)
267                 cputime_clock = CPUTIME_CLOCK_I8254;
268         gp->profrate = timer_freq << CPUTIME_CLOCK_I8254_SHIFT;
269         cputime_bias = 0;
270         cputime();
271 }
272
273 void
274 stopguprof(struct gmonparam *gp)
275 {
276 #if defined(PERFMON) && defined(I586_PMC_GUPROF)
277         if (cputime_clock_pmc_init) {
278                 *gp = saved_gmp;
279                 perfmon_fini(0);
280                 cputime_clock_pmc_init = FALSE;
281         }
282 #endif
283 }
284
285 #else /* !GUPROF */
286 #ifdef __GNUC__
287 __asm("                                                         \n\
288         .text                                                   \n\
289         .p2align 4,0x90                                         \n\
290         .globl  " __XSTRING(HIDENAME(mexitcount)) "             \n\
291 " __XSTRING(HIDENAME(mexitcount)) ":                            \n\
292         ret                                                     \n\
293 ");
294 #else /* !__GNUC__ */
295 #error
296 #endif /* __GNUC__ */
297 #endif /* GUPROF */