clock.c revision 1.2.10.3
1 1.2.10.3 jdolecek /* $NetBSD: clock.c,v 1.2.10.3 2002/09/06 08:39:02 jdolecek Exp $ */ 2 1.2.10.2 jdolecek /* $OpenBSD: clock.c,v 1.3 1997/10/13 13:42:53 pefo Exp $ */ 3 1.2.10.2 jdolecek 4 1.2.10.2 jdolecek /* 5 1.2.10.2 jdolecek * Copyright (C) 1995, 1996 Wolfgang Solfrank. 6 1.2.10.2 jdolecek * Copyright (C) 1995, 1996 TooLs GmbH. 7 1.2.10.2 jdolecek * All rights reserved. 8 1.2.10.2 jdolecek * 9 1.2.10.2 jdolecek * Redistribution and use in source and binary forms, with or without 10 1.2.10.2 jdolecek * modification, are permitted provided that the following conditions 11 1.2.10.2 jdolecek * are met: 12 1.2.10.2 jdolecek * 1. Redistributions of source code must retain the above copyright 13 1.2.10.2 jdolecek * notice, this list of conditions and the following disclaimer. 14 1.2.10.2 jdolecek * 2. Redistributions in binary form must reproduce the above copyright 15 1.2.10.2 jdolecek * notice, this list of conditions and the following disclaimer in the 16 1.2.10.2 jdolecek * documentation and/or other materials provided with the distribution. 17 1.2.10.2 jdolecek * 3. All advertising materials mentioning features or use of this software 18 1.2.10.2 jdolecek * must display the following acknowledgement: 19 1.2.10.2 jdolecek * This product includes software developed by TooLs GmbH. 20 1.2.10.2 jdolecek * 4. The name of TooLs GmbH may not be used to endorse or promote products 21 1.2.10.2 jdolecek * derived from this software without specific prior written permission. 22 1.2.10.2 jdolecek * 23 1.2.10.2 jdolecek * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR 24 1.2.10.2 jdolecek * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 25 1.2.10.2 jdolecek * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 26 1.2.10.2 jdolecek * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 27 1.2.10.2 jdolecek * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 28 1.2.10.2 jdolecek * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; 29 1.2.10.2 jdolecek * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, 30 1.2.10.2 jdolecek * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR 31 1.2.10.2 jdolecek * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF 32 1.2.10.2 jdolecek * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 33 1.2.10.2 jdolecek */ 34 1.2.10.2 jdolecek 35 1.2.10.2 jdolecek #include <sys/param.h> 36 1.2.10.2 jdolecek #include <sys/kernel.h> 37 1.2.10.2 jdolecek #include <sys/systm.h> 38 1.2.10.2 jdolecek #include <sys/properties.h> 39 1.2.10.2 jdolecek 40 1.2.10.2 jdolecek #include <machine/dcr.h> 41 1.2.10.2 jdolecek 42 1.2.10.2 jdolecek #include <powerpc/spr.h> 43 1.2.10.2 jdolecek 44 1.2.10.2 jdolecek /* 45 1.2.10.2 jdolecek * Initially we assume a processor with a bus frequency of 12.5 MHz. 46 1.2.10.2 jdolecek */ 47 1.2.10.2 jdolecek static u_long ticks_per_sec; 48 1.2.10.2 jdolecek static u_long ns_per_tick; 49 1.2.10.2 jdolecek static long ticks_per_intr; 50 1.2.10.2 jdolecek static volatile u_long lasttb; 51 1.2.10.2 jdolecek static u_long ticksmissed; 52 1.2.10.2 jdolecek static volatile int tickspending; 53 1.2.10.2 jdolecek 54 1.2.10.2 jdolecek void decr_intr(struct clockframe *); /* called from trap_subr.S */ 55 1.2.10.2 jdolecek void stat_intr(struct clockframe *); /* called from trap_subr.S */ 56 1.2.10.2 jdolecek 57 1.2.10.2 jdolecek #ifdef FAST_STAT_CLOCK 58 1.2.10.2 jdolecek /* Stat clock runs at ~ 1.5KHz */ 59 1.2.10.2 jdolecek #define PERIOD_POWER 17 60 1.2.10.2 jdolecek #define TCR_PERIOD TCR_FP_2_17 61 1.2.10.2 jdolecek #else 62 1.2.10.2 jdolecek /* Stat clock runs at ~ 95Hz */ 63 1.2.10.2 jdolecek #define PERIOD_POWER 21 64 1.2.10.2 jdolecek #define TCR_PERIOD TCR_FP_2_21 65 1.2.10.3 jdolecek #endif 66 1.2.10.2 jdolecek 67 1.2.10.2 jdolecek 68 1.2.10.2 jdolecek void 69 1.2.10.2 jdolecek stat_intr(struct clockframe *frame) 70 1.2.10.2 jdolecek { 71 1.2.10.2 jdolecek extern u_long intrcnt[]; 72 1.2.10.3 jdolecek 73 1.2.10.2 jdolecek mtspr(SPR_TSR, TSR_FIS); /* Clear TSR[FIS] */ 74 1.2.10.2 jdolecek intrcnt[CNT_STATCLOCK]++; 75 1.2.10.2 jdolecek statclock(frame); 76 1.2.10.2 jdolecek } 77 1.2.10.2 jdolecek 78 1.2.10.2 jdolecek void 79 1.2.10.2 jdolecek decr_intr(struct clockframe *frame) 80 1.2.10.2 jdolecek { 81 1.2.10.2 jdolecek int pri; 82 1.2.10.2 jdolecek long tick, xticks; 83 1.2.10.2 jdolecek int nticks; 84 1.2.10.2 jdolecek extern u_long intrcnt[]; 85 1.2.10.2 jdolecek /* 86 1.2.10.2 jdolecek * Check whether we are initialized. 87 1.2.10.2 jdolecek */ 88 1.2.10.2 jdolecek if (!ticks_per_intr) 89 1.2.10.2 jdolecek return; 90 1.2.10.2 jdolecek 91 1.2.10.2 jdolecek asm volatile("mftb %0":"=r"(tick):); 92 1.2.10.2 jdolecek mtspr(SPR_TSR, TSR_PIS); /* Clear TSR[PIS] */ 93 1.2.10.2 jdolecek /* 94 1.2.10.2 jdolecek * lasttb is used during microtime. Set it to the virtual 95 1.2.10.2 jdolecek * start of this tick interval. 96 1.2.10.2 jdolecek */ 97 1.2.10.2 jdolecek xticks = tick - lasttb; /* Number of TLB cycles since last exception */ 98 1.2.10.2 jdolecek for (nticks = 0; xticks > ticks_per_intr; nticks++) 99 1.2.10.2 jdolecek xticks -= ticks_per_intr; 100 1.2.10.2 jdolecek lasttb = tick - xticks; 101 1.2.10.2 jdolecek 102 1.2.10.2 jdolecek intrcnt[CNT_CLOCK]++; 103 1.2.10.2 jdolecek pri = splclock(); 104 1.2.10.2 jdolecek if (pri & SPL_CLOCK) { 105 1.2.10.2 jdolecek tickspending += nticks; 106 1.2.10.2 jdolecek ticksmissed+= nticks; 107 1.2.10.2 jdolecek } else { 108 1.2.10.2 jdolecek nticks += tickspending; 109 1.2.10.2 jdolecek tickspending = 0; 110 1.2.10.2 jdolecek 111 1.2.10.2 jdolecek /* 112 1.2.10.2 jdolecek * Reenable interrupts 113 1.2.10.2 jdolecek */ 114 1.2.10.2 jdolecek asm volatile ("wrteei 1"); 115 1.2.10.2 jdolecek 116 1.2.10.2 jdolecek /* 117 1.2.10.2 jdolecek * Do standard timer interrupt stuff. 118 1.2.10.2 jdolecek * Do softclock stuff only on the last iteration. 119 1.2.10.2 jdolecek */ 120 1.2.10.2 jdolecek frame->pri = pri | SINT_CLOCK; 121 1.2.10.2 jdolecek while (--nticks > 0) 122 1.2.10.2 jdolecek hardclock(frame); 123 1.2.10.2 jdolecek frame->pri = pri; 124 1.2.10.2 jdolecek hardclock(frame); 125 1.2.10.2 jdolecek } 126 1.2.10.2 jdolecek splx(pri); 127 1.2.10.2 jdolecek } 128 1.2.10.2 jdolecek 129 1.2.10.2 jdolecek void 130 1.2.10.2 jdolecek cpu_initclocks(void) 131 1.2.10.2 jdolecek { 132 1.2.10.3 jdolecek 133 1.2.10.2 jdolecek ticks_per_intr = ticks_per_sec / hz; 134 1.2.10.3 jdolecek stathz = profhz = ticks_per_sec / (1 << PERIOD_POWER); 135 1.2.10.2 jdolecek printf("Setting PIT to %ld/%d = %ld\n", ticks_per_sec, hz, ticks_per_intr); 136 1.2.10.2 jdolecek asm volatile ("mftb %0" : "=r"(lasttb)); 137 1.2.10.2 jdolecek mtspr(SPR_PIT, ticks_per_intr); 138 1.2.10.2 jdolecek /* Enable PIT & FIT(2^17c = 0.655ms) interrupts and auto-reload */ 139 1.2.10.3 jdolecek mtspr(SPR_TCR, TCR_PIE | TCR_ARE | TCR_FIE | TCR_PERIOD); 140 1.2.10.2 jdolecek } 141 1.2.10.2 jdolecek 142 1.2.10.2 jdolecek void 143 1.2.10.2 jdolecek calc_delayconst(void) 144 1.2.10.2 jdolecek { 145 1.2.10.2 jdolecek unsigned int processor_freq; 146 1.2.10.2 jdolecek 147 1.2.10.3 jdolecek if (board_info_get("processor-frequency", 148 1.2.10.2 jdolecek &processor_freq, sizeof(processor_freq)) == -1) 149 1.2.10.2 jdolecek panic("no processor-frequency"); 150 1.2.10.2 jdolecek 151 1.2.10.2 jdolecek ticks_per_sec = processor_freq; 152 1.2.10.2 jdolecek ns_per_tick = 1000000000 / ticks_per_sec; 153 1.2.10.2 jdolecek } 154 1.2.10.2 jdolecek 155 1.2.10.2 jdolecek /* 156 1.2.10.2 jdolecek * Fill in *tvp with current time with microsecond resolution. 157 1.2.10.2 jdolecek */ 158 1.2.10.2 jdolecek void 159 1.2.10.2 jdolecek microtime(struct timeval *tvp) 160 1.2.10.2 jdolecek { 161 1.2.10.2 jdolecek u_long tb; 162 1.2.10.2 jdolecek u_long ticks; 163 1.2.10.2 jdolecek int msr; 164 1.2.10.2 jdolecek 165 1.2.10.2 jdolecek asm volatile ("mfmsr %0; wrteei 0" : "=r"(msr) :); 166 1.2.10.2 jdolecek asm ("mftb %0" : "=r"(tb)); 167 1.2.10.2 jdolecek ticks = (tb - lasttb) * ns_per_tick; 168 1.2.10.2 jdolecek *tvp = time; 169 1.2.10.2 jdolecek asm volatile ("mtmsr %0" :: "r"(msr)); 170 1.2.10.2 jdolecek ticks /= 1000; 171 1.2.10.2 jdolecek tvp->tv_usec += ticks; 172 1.2.10.2 jdolecek while (tvp->tv_usec >= 1000000) { 173 1.2.10.2 jdolecek tvp->tv_usec -= 1000000; 174 1.2.10.2 jdolecek tvp->tv_sec++; 175 1.2.10.2 jdolecek } 176 1.2.10.2 jdolecek } 177 1.2.10.2 jdolecek 178 1.2.10.2 jdolecek /* 179 1.2.10.2 jdolecek * Wait for about n microseconds (at least!). 180 1.2.10.2 jdolecek */ 181 1.2.10.2 jdolecek void 182 1.2.10.2 jdolecek delay(unsigned int n) 183 1.2.10.2 jdolecek { 184 1.2.10.2 jdolecek u_quad_t tb; 185 1.2.10.2 jdolecek u_long tbh, tbl, scratch; 186 1.2.10.2 jdolecek 187 1.2.10.2 jdolecek tb = mftb(); 188 1.2.10.2 jdolecek /* use 1000ULL to force 64 bit math to avoid 32 bit overflows */ 189 1.2.10.2 jdolecek tb += (n * 1000ULL + ns_per_tick - 1) / ns_per_tick; 190 1.2.10.2 jdolecek tbh = tb >> 32; 191 1.2.10.2 jdolecek tbl = tb; 192 1.2.10.2 jdolecek asm volatile ("1: mftbu %0; cmplw %0,%1; blt 1b; bgt 2f;" 193 1.2.10.2 jdolecek "mftb %0; cmplw %0,%2; blt 1b; 2:" 194 1.2.10.2 jdolecek : "=r"(scratch) : "r"(tbh), "r"(tbl)); 195 1.2.10.2 jdolecek } 196 1.2.10.2 jdolecek 197 1.2.10.2 jdolecek /* 198 1.2.10.2 jdolecek * Nothing to do. 199 1.2.10.2 jdolecek */ 200 1.2.10.2 jdolecek void 201 1.2.10.2 jdolecek setstatclockrate(int arg) 202 1.2.10.2 jdolecek { 203 1.2.10.2 jdolecek 204 1.2.10.2 jdolecek /* Do nothing */ 205 1.2.10.2 jdolecek } 206
Indexes created Wed Oct 01 18:09:54 GMT 2025