1 /* $NetBSD: cortex_pmc.c,v 1.6 2018/07/12 10:46:42 maxv Exp $ */ 2 3 /* Copyright (c) 2007 Microsoft 4 * All rights reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 3. All advertising materials mentioning features or use of this software 15 * must display the following acknowledgement: 16 * This product includes software developed by Microsoft 17 * 18 * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND 19 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 20 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 21 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC 22 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 23 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 24 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 25 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 26 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 27 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 28 * POSSIBILITY OF SUCH DAMAGE. 29 */ 30 31 32 /* 33 * support for ARM cortex Performance Monitor Counters 34 * based on arm11_pmc.c 35 */ 36 37 #include <sys/cdefs.h> 38 /* __KERNEL_RCSID(0, "$NetBSD: cortex_pmc.c,v 1.6 2018/07/12 10:46:42 maxv Exp $"); */ 39 #include <sys/types.h> 40 #include <sys/param.h> 41 #include <sys/systm.h> 42 #include <sys/kernel.h> 43 #include <sys/time.h> 44 #include <sys/timetc.h> 45 46 #include <dev/clock_subr.h> 47 48 #include <uvm/uvm_extern.h> 49 50 #include <arm/armreg.h> 51 #include <arm/cpufunc.h> 52 #include <arm/arm32/machdep.h> 53 54 #ifndef CORTEX_PMC_CCNT_HZ 55 # define CORTEX_PMC_CCNT_HZ 400000000 /* 400MHz */ 56 #endif 57 58 #define COUNTS_PER_USEC (curcpu()->ci_data.cpu_cc_freq / (1000*1000)) 59 60 static const uint32_t counts_per_wrap = ~0UL - 1; 61 62 /* 63 * enable the PMC CCNT for delay() 64 */ 65 void 66 cortex_pmc_ccnt_init(void) 67 { 68 if (curcpu()->ci_data.cpu_cc_freq == 0) { 69 curcpu()->ci_data.cpu_cc_freq = CORTEX_PMC_CCNT_HZ; 70 } 71 } 72 73 /* 74 * delay - for "at least" arg usec 75 * 76 * NOTE: at 400MHz we are restricted to (uint32_t)~0 "counts" 77 * if this is a problem, accumulate counts in LL vars 78 */ 79 void 80 delay(u_int arg) 81 { 82 uint32_t ctrl; 83 uint32_t cur; 84 uint32_t last; 85 uint32_t delta = 0; 86 uint32_t usecs = 0; 87 const uint32_t counts_per_usec = COUNTS_PER_USEC; 88 const uint32_t delay_arg_limit = ~0UL / counts_per_usec; /* about 10 sec */ 89 90 if (arg > delay_arg_limit) 91 panic("%s: arg %u overflow, limit is %u usec\n", 92 __func__, arg, delay_arg_limit); 93 94 last = armreg_pmccntr_read(); 95 delta = usecs = 0; 96 while (arg > usecs) { 97 cur = armreg_pmccntr_read(); 98 99 /* 100 * overflow flag is moved to a separate register 101 * and is not read from PMC Control Register 102 */ 103 ctrl = armreg_pmovsr_read(); 104 if (ctrl & CORTEX_CNTOFL_C) { 105 /* 106 * Reset overflow flag for cycle counter in overflow 107 * register 108 */ 109 armreg_pmovsr_write(CORTEX_CNTOFL_C); 110 delta += (cur + (counts_per_wrap - last)); 111 } else { 112 delta += (cur - last); 113 } 114 last = cur; 115 if (delta >= counts_per_usec) { 116 usecs += delta / counts_per_usec; 117 delta %= counts_per_usec; 118 } 119 } 120 } 121