xref: /freebsd/stand/libsa/powerpc/syncicache.c (revision a91a246563dffa876a52f53a98de4af9fa364c52)
1 /*-
2  * Copyright (C) 1995-1997, 1999 Wolfgang Solfrank.
3  * Copyright (C) 1995-1997, 1999 TooLs GmbH.
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 TooLs GmbH.
17  * 4. The name of TooLs GmbH may not be used to endorse or promote products
18  *    derived from this software without specific prior written permission.
19  *
20  * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR
21  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
23  * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
24  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
25  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
26  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
27  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
28  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
29  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30  *
31  * $NetBSD: syncicache.c,v 1.2 1999/05/05 12:36:40 tsubai Exp $
32  */
33 
34 #include <sys/param.h>
35 #if	defined(_KERNEL) || defined(_STANDALONE)
36 #include <sys/time.h>
37 #include <sys/proc.h>
38 #include <vm/vm.h>
39 #endif
40 #include <sys/sysctl.h>
41 
42 #include <machine/cpu.h>
43 #include <machine/md_var.h>
44 
45 #ifdef _STANDALONE
46 int cacheline_size = 32;
47 #endif
48 
49 #if	!defined(_KERNEL) && !defined(_STANDALONE)
50 #include <stdlib.h>
51 
52 int cacheline_size = 0;
53 
54 static void getcachelinesize(void);
55 
56 static void
57 getcachelinesize(void)
58 {
59 	static int	cachemib[] = { CTL_MACHDEP, CPU_CACHELINE };
60 	int		clen;
61 
62 	clen = sizeof(cacheline_size);
63 
64 	if (sysctl(cachemib, sizeof(cachemib) / sizeof(cachemib[0]),
65 	    &cacheline_size, &clen, NULL, 0) < 0 || !cacheline_size) {
66 		abort();
67 	}
68 }
69 #endif
70 
71 void
72 __syncicache(void *from, int len)
73 {
74 	int	l, off;
75 	char	*p;
76 
77 #if	!defined(_KERNEL) && !defined(_STANDALONE)
78 	if (!cacheline_size)
79 		getcachelinesize();
80 #endif
81 
82 	off = (u_int)from & (cacheline_size - 1);
83 	l = len += off;
84 	p = (char *)from - off;
85 
86 	do {
87 		__asm __volatile ("dcbst 0,%0" :: "r"(p));
88 		p += cacheline_size;
89 	} while ((l -= cacheline_size) > 0);
90 	__asm __volatile ("sync");
91 	p = (char *)from - off;
92 	do {
93 		__asm __volatile ("icbi 0,%0" :: "r"(p));
94 		p += cacheline_size;
95 	} while ((len -= cacheline_size) > 0);
96 	__asm __volatile ("sync; isync");
97 }
98 
99