xref: /freebsd/sys/arm/include/counter.h (revision 95ee2897)
14e76af6aSGleb Smirnoff /*-
24d846d26SWarner Losh  * SPDX-License-Identifier: BSD-2-Clause
3af3dc4a7SPedro F. Giffuni  *
44e76af6aSGleb Smirnoff  * Copyright (c) 2012 Konstantin Belousov <kib@FreeBSD.org>
54e76af6aSGleb Smirnoff  * All rights reserved.
64e76af6aSGleb Smirnoff  *
74e76af6aSGleb Smirnoff  * Redistribution and use in source and binary forms, with or without
84e76af6aSGleb Smirnoff  * modification, are permitted provided that the following conditions
94e76af6aSGleb Smirnoff  * are met:
104e76af6aSGleb Smirnoff  * 1. Redistributions of source code must retain the above copyright
114e76af6aSGleb Smirnoff  *    notice, this list of conditions and the following disclaimer.
124e76af6aSGleb Smirnoff  * 2. Redistributions in binary form must reproduce the above copyright
134e76af6aSGleb Smirnoff  *    notice, this list of conditions and the following disclaimer in the
144e76af6aSGleb Smirnoff  *    documentation and/or other materials provided with the distribution.
154e76af6aSGleb Smirnoff  *
164e76af6aSGleb Smirnoff  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
174e76af6aSGleb Smirnoff  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
184e76af6aSGleb Smirnoff  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
194e76af6aSGleb Smirnoff  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
204e76af6aSGleb Smirnoff  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
214e76af6aSGleb Smirnoff  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
224e76af6aSGleb Smirnoff  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
234e76af6aSGleb Smirnoff  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
244e76af6aSGleb Smirnoff  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
254e76af6aSGleb Smirnoff  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
264e76af6aSGleb Smirnoff  * SUCH DAMAGE.
274e76af6aSGleb Smirnoff  */
284e76af6aSGleb Smirnoff 
294e76af6aSGleb Smirnoff #ifndef __MACHINE_COUNTER_H__
304e76af6aSGleb Smirnoff #define __MACHINE_COUNTER_H__
314e76af6aSGleb Smirnoff 
324e76af6aSGleb Smirnoff #include <sys/pcpu.h>
33eaa4e276SIan Lepore #include <machine/atomic.h>
344e76af6aSGleb Smirnoff 
3583c9dea1SGleb Smirnoff #define	EARLY_COUNTER	&__pcpu[0].pc_early_dummy_counter
3683c9dea1SGleb Smirnoff 
373b7a388bSKonstantin Belousov #define	counter_enter()	do {} while (0)
383b7a388bSKonstantin Belousov #define	counter_exit()	do {} while (0)
394e76af6aSGleb Smirnoff 
4070a7dd5dSKonstantin Belousov #ifdef IN_SUBR_COUNTER_C
41eaa4e276SIan Lepore 
4270a7dd5dSKonstantin Belousov static inline uint64_t
counter_u64_read_one(uint64_t * p,int cpu)4370a7dd5dSKonstantin Belousov counter_u64_read_one(uint64_t *p, int cpu)
4470a7dd5dSKonstantin Belousov {
4570a7dd5dSKonstantin Belousov 
4678e3a168SMateusz Guzik 	return (atomic_load_64((uint64_t *)zpcpu_get_cpu(p, cpu)));
4770a7dd5dSKonstantin Belousov }
4870a7dd5dSKonstantin Belousov 
4970a7dd5dSKonstantin Belousov static inline uint64_t
counter_u64_fetch_inline(uint64_t * p)5070a7dd5dSKonstantin Belousov counter_u64_fetch_inline(uint64_t *p)
5170a7dd5dSKonstantin Belousov {
5270a7dd5dSKonstantin Belousov 	uint64_t r;
5370a7dd5dSKonstantin Belousov 	int i;
5470a7dd5dSKonstantin Belousov 
5570a7dd5dSKonstantin Belousov 	r = 0;
563b7a388bSKonstantin Belousov 	CPU_FOREACH(i)
5770a7dd5dSKonstantin Belousov 		r += counter_u64_read_one((uint64_t *)p, i);
5870a7dd5dSKonstantin Belousov 
5970a7dd5dSKonstantin Belousov 	return (r);
6070a7dd5dSKonstantin Belousov }
6170a7dd5dSKonstantin Belousov 
6270a7dd5dSKonstantin Belousov static void
counter_u64_zero_one_cpu(void * arg)6370a7dd5dSKonstantin Belousov counter_u64_zero_one_cpu(void *arg)
6470a7dd5dSKonstantin Belousov {
6570a7dd5dSKonstantin Belousov 
6678e3a168SMateusz Guzik 	atomic_store_64((uint64_t *)zpcpu_get(arg), 0);
6770a7dd5dSKonstantin Belousov }
6870a7dd5dSKonstantin Belousov 
6970a7dd5dSKonstantin Belousov static inline void
counter_u64_zero_inline(counter_u64_t c)7070a7dd5dSKonstantin Belousov counter_u64_zero_inline(counter_u64_t c)
7170a7dd5dSKonstantin Belousov {
7270a7dd5dSKonstantin Belousov 
7367d955aaSPatrick Kelsey 	smp_rendezvous(smp_no_rendezvous_barrier, counter_u64_zero_one_cpu,
7467d955aaSPatrick Kelsey 	    smp_no_rendezvous_barrier, c);
7570a7dd5dSKonstantin Belousov }
7670a7dd5dSKonstantin Belousov #endif
7770a7dd5dSKonstantin Belousov 
783b7a388bSKonstantin Belousov #define	counter_u64_add_protected(c, inc)	counter_u64_add(c, inc)
794e76af6aSGleb Smirnoff 
804e76af6aSGleb Smirnoff static inline void
counter_u64_add(counter_u64_t c,int64_t inc)814e76af6aSGleb Smirnoff counter_u64_add(counter_u64_t c, int64_t inc)
824e76af6aSGleb Smirnoff {
834e76af6aSGleb Smirnoff 
843b7a388bSKonstantin Belousov 	atomic_add_64((uint64_t *)zpcpu_get(c), inc);
854e76af6aSGleb Smirnoff }
864e76af6aSGleb Smirnoff 
874e76af6aSGleb Smirnoff #endif	/* ! __MACHINE_COUNTER_H__ */
88