13c4dd356SDavid Greenman /*- 23c4dd356SDavid Greenman * Copyright (c) 1993 The Regents of the University of California. 33c4dd356SDavid Greenman * All rights reserved. 43c4dd356SDavid Greenman * 53c4dd356SDavid Greenman * Redistribution and use in source and binary forms, with or without 63c4dd356SDavid Greenman * modification, are permitted provided that the following conditions 73c4dd356SDavid Greenman * are met: 83c4dd356SDavid Greenman * 1. Redistributions of source code must retain the above copyright 93c4dd356SDavid Greenman * notice, this list of conditions and the following disclaimer. 103c4dd356SDavid Greenman * 2. Redistributions in binary form must reproduce the above copyright 113c4dd356SDavid Greenman * notice, this list of conditions and the following disclaimer in the 123c4dd356SDavid Greenman * documentation and/or other materials provided with the distribution. 133c4dd356SDavid Greenman * 3. All advertising materials mentioning features or use of this software 143c4dd356SDavid Greenman * must display the following acknowledgement: 153c4dd356SDavid Greenman * This product includes software developed by the University of 163c4dd356SDavid Greenman * California, Berkeley and its contributors. 173c4dd356SDavid Greenman * 4. Neither the name of the University nor the names of its contributors 183c4dd356SDavid Greenman * may be used to endorse or promote products derived from this software 193c4dd356SDavid Greenman * without specific prior written permission. 203c4dd356SDavid Greenman * 213c4dd356SDavid Greenman * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 223c4dd356SDavid Greenman * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 233c4dd356SDavid Greenman * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 243c4dd356SDavid Greenman * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 253c4dd356SDavid Greenman * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 263c4dd356SDavid Greenman * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 273c4dd356SDavid Greenman * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 283c4dd356SDavid Greenman * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 293c4dd356SDavid Greenman * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 303c4dd356SDavid Greenman * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 313c4dd356SDavid Greenman * SUCH DAMAGE. 323c4dd356SDavid Greenman * 33ece15d78SBruce Evans * $Id: cpufunc.h,v 1.58 1996/09/28 22:37:57 dyson Exp $ 343c4dd356SDavid Greenman */ 353c4dd356SDavid Greenman 365b81b6b3SRodney W. Grimes /* 375b81b6b3SRodney W. Grimes * Functions to provide access to special i386 instructions. 385b81b6b3SRodney W. Grimes */ 395b81b6b3SRodney W. Grimes 406e393973SGarrett Wollman #ifndef _MACHINE_CPUFUNC_H_ 41004bedebSBruce Evans #define _MACHINE_CPUFUNC_H_ 426e393973SGarrett Wollman 435b81b6b3SRodney W. Grimes #include <sys/cdefs.h> 445b81b6b3SRodney W. Grimes #include <sys/types.h> 455b81b6b3SRodney W. Grimes 465b81b6b3SRodney W. Grimes #ifdef __GNUC__ 475b81b6b3SRodney W. Grimes 485dbd168eSBruce Evans static __inline void 495dbd168eSBruce Evans breakpoint(void) 50004bedebSBruce Evans { 51004bedebSBruce Evans __asm __volatile("int $3"); 525b81b6b3SRodney W. Grimes } 535b81b6b3SRodney W. Grimes 54004bedebSBruce Evans static __inline void 555b81b6b3SRodney W. Grimes disable_intr(void) 565b81b6b3SRodney W. Grimes { 578966b85cSJohn Dyson __asm __volatile("cli" : : : "memory"); 585b81b6b3SRodney W. Grimes } 595b81b6b3SRodney W. Grimes 60004bedebSBruce Evans static __inline void 615b81b6b3SRodney W. Grimes enable_intr(void) 625b81b6b3SRodney W. Grimes { 63fadc51bdSBruce Evans __asm __volatile("sti"); 645b81b6b3SRodney W. Grimes } 655b81b6b3SRodney W. Grimes 66004bedebSBruce Evans #define HAVE_INLINE_FFS 67004bedebSBruce Evans 68004bedebSBruce Evans static __inline int 69004bedebSBruce Evans ffs(int mask) 70004bedebSBruce Evans { 71004bedebSBruce Evans int result; 72004bedebSBruce Evans /* 73004bedebSBruce Evans * bsfl turns out to be not all that slow on 486's. It can beaten 74004bedebSBruce Evans * using a binary search to reduce to 4 bits and then a table lookup, 75004bedebSBruce Evans * but only if the code is inlined and in the cache, and the code 76004bedebSBruce Evans * is quite large so inlining it probably busts the cache. 77004bedebSBruce Evans * 78004bedebSBruce Evans * Note that gcc-2's builtin ffs would be used if we didn't declare 79004bedebSBruce Evans * this inline or turn off the builtin. The builtin is faster but 80004bedebSBruce Evans * broken in gcc-2.4.5 and slower but working in gcc-2.5 and 2.6. 81004bedebSBruce Evans */ 82004bedebSBruce Evans __asm __volatile("testl %0,%0; je 1f; bsfl %0,%0; incl %0; 1:" 83004bedebSBruce Evans : "=r" (result) : "0" (mask)); 84004bedebSBruce Evans return (result); 85004bedebSBruce Evans } 86004bedebSBruce Evans 8713f588f8SGarrett Wollman #define HAVE_INLINE_FLS 8813f588f8SGarrett Wollman 8913f588f8SGarrett Wollman static __inline int 9013f588f8SGarrett Wollman fls(int mask) 9113f588f8SGarrett Wollman { 9213f588f8SGarrett Wollman int result; 9313f588f8SGarrett Wollman __asm __volatile("testl %0,%0; je 1f; bsrl %0,%0; incl %0; 1:" 9413f588f8SGarrett Wollman : "=r" (result) : "0" (mask)); 9513f588f8SGarrett Wollman return (result); 9613f588f8SGarrett Wollman } 9713f588f8SGarrett Wollman 98004bedebSBruce Evans #if __GNUC__ < 2 99004bedebSBruce Evans 100004bedebSBruce Evans #define inb(port) inbv(port) 101004bedebSBruce Evans #define outb(port, data) outbv(port, data) 102004bedebSBruce Evans 103004bedebSBruce Evans #else /* __GNUC >= 2 */ 104004bedebSBruce Evans 105004bedebSBruce Evans /* 1068089a043SBruce Evans * The following complications are to get around gcc not having a 1078089a043SBruce Evans * constraint letter for the range 0..255. We still put "d" in the 1088089a043SBruce Evans * constraint because "i" isn't a valid constraint when the port 1098089a043SBruce Evans * isn't constant. This only matters for -O0 because otherwise 1108089a043SBruce Evans * the non-working version gets optimized away. 1118089a043SBruce Evans * 112004bedebSBruce Evans * Use an expression-statement instead of a conditional expression 113004bedebSBruce Evans * because gcc-2.6.0 would promote the operands of the conditional 114004bedebSBruce Evans * and produce poor code for "if ((inb(var) & const1) == const2)". 115388dfa71SBruce Evans * 116388dfa71SBruce Evans * The unnecessary test `(port) < 0x10000' is to generate a warning if 117388dfa71SBruce Evans * the `port' has type u_short or smaller. Such types are pessimal. 118388dfa71SBruce Evans * This actually only works for signed types. The range check is 119388dfa71SBruce Evans * careful to avoid generating warnings. 120004bedebSBruce Evans */ 121388dfa71SBruce Evans #define inb(port) __extension__ ({ \ 122004bedebSBruce Evans u_char _data; \ 123388dfa71SBruce Evans if (__builtin_constant_p(port) && ((port) & 0xffff) < 0x100 \ 124388dfa71SBruce Evans && (port) < 0x10000) \ 125004bedebSBruce Evans _data = inbc(port); \ 126004bedebSBruce Evans else \ 127004bedebSBruce Evans _data = inbv(port); \ 128004bedebSBruce Evans _data; }) 129004bedebSBruce Evans 130388dfa71SBruce Evans #define outb(port, data) ( \ 131388dfa71SBruce Evans __builtin_constant_p(port) && ((port) & 0xffff) < 0x100 \ 132388dfa71SBruce Evans && (port) < 0x10000 \ 133004bedebSBruce Evans ? outbc(port, data) : outbv(port, data)) 134004bedebSBruce Evans 135004bedebSBruce Evans static __inline u_char 136004bedebSBruce Evans inbc(u_int port) 137004bedebSBruce Evans { 138004bedebSBruce Evans u_char data; 139004bedebSBruce Evans 1408089a043SBruce Evans __asm __volatile("inb %1,%0" : "=a" (data) : "id" ((u_short)(port))); 141004bedebSBruce Evans return (data); 142004bedebSBruce Evans } 143004bedebSBruce Evans 144004bedebSBruce Evans static __inline void 145004bedebSBruce Evans outbc(u_int port, u_char data) 146004bedebSBruce Evans { 1478089a043SBruce Evans __asm __volatile("outb %0,%1" : : "a" (data), "id" ((u_short)(port))); 148004bedebSBruce Evans } 149004bedebSBruce Evans 150004bedebSBruce Evans #endif /* __GNUC <= 2 */ 151004bedebSBruce Evans 152004bedebSBruce Evans static __inline u_char 153004bedebSBruce Evans inbv(u_int port) 154004bedebSBruce Evans { 155004bedebSBruce Evans u_char data; 156004bedebSBruce Evans /* 157004bedebSBruce Evans * We use %%dx and not %1 here because i/o is done at %dx and not at 158004bedebSBruce Evans * %edx, while gcc generates inferior code (movw instead of movl) 159004bedebSBruce Evans * if we tell it to load (u_short) port. 160004bedebSBruce Evans */ 161004bedebSBruce Evans __asm __volatile("inb %%dx,%0" : "=a" (data) : "d" (port)); 162004bedebSBruce Evans return (data); 163004bedebSBruce Evans } 164004bedebSBruce Evans 165004bedebSBruce Evans static __inline u_long 166004bedebSBruce Evans inl(u_int port) 167004bedebSBruce Evans { 168004bedebSBruce Evans u_long data; 169004bedebSBruce Evans 170004bedebSBruce Evans __asm __volatile("inl %%dx,%0" : "=a" (data) : "d" (port)); 171004bedebSBruce Evans return (data); 172004bedebSBruce Evans } 173004bedebSBruce Evans 174004bedebSBruce Evans static __inline void 175004bedebSBruce Evans insb(u_int port, void *addr, size_t cnt) 176004bedebSBruce Evans { 177004bedebSBruce Evans __asm __volatile("cld; rep; insb" 178004bedebSBruce Evans : : "d" (port), "D" (addr), "c" (cnt) 179004bedebSBruce Evans : "di", "cx", "memory"); 180004bedebSBruce Evans } 181004bedebSBruce Evans 182004bedebSBruce Evans static __inline void 183004bedebSBruce Evans insw(u_int port, void *addr, size_t cnt) 184004bedebSBruce Evans { 185004bedebSBruce Evans __asm __volatile("cld; rep; insw" 186004bedebSBruce Evans : : "d" (port), "D" (addr), "c" (cnt) 187004bedebSBruce Evans : "di", "cx", "memory"); 188004bedebSBruce Evans } 189004bedebSBruce Evans 190004bedebSBruce Evans static __inline void 191004bedebSBruce Evans insl(u_int port, void *addr, size_t cnt) 192004bedebSBruce Evans { 193004bedebSBruce Evans __asm __volatile("cld; rep; insl" 194004bedebSBruce Evans : : "d" (port), "D" (addr), "c" (cnt) 195004bedebSBruce Evans : "di", "cx", "memory"); 196004bedebSBruce Evans } 197004bedebSBruce Evans 198ece15d78SBruce Evans static __inline void 199ece15d78SBruce Evans invlpg(u_int addr) 200ece15d78SBruce Evans { 201ece15d78SBruce Evans __asm __volatile("invlpg (%0)" : : "r" (addr) : "memory"); 202ece15d78SBruce Evans } 203ece15d78SBruce Evans 204ece15d78SBruce Evans static __inline void 205ece15d78SBruce Evans invltlb(void) 206ece15d78SBruce Evans { 207ece15d78SBruce Evans u_long temp; 208ece15d78SBruce Evans /* 209ece15d78SBruce Evans * This should be implemented as load_cr3(rcr3()) when load_cr3() 210ece15d78SBruce Evans * is inlined. 211ece15d78SBruce Evans */ 212ece15d78SBruce Evans __asm __volatile("movl %%cr3, %0; movl %0, %%cr3" : "=r" (temp) 213ece15d78SBruce Evans : : "memory"); 214ece15d78SBruce Evans } 215ece15d78SBruce Evans 216004bedebSBruce Evans static __inline u_short 217004bedebSBruce Evans inw(u_int port) 218004bedebSBruce Evans { 219004bedebSBruce Evans u_short data; 220004bedebSBruce Evans 221004bedebSBruce Evans __asm __volatile("inw %%dx,%0" : "=a" (data) : "d" (port)); 222004bedebSBruce Evans return (data); 223004bedebSBruce Evans } 224004bedebSBruce Evans 2255dbd168eSBruce Evans static __inline u_int 2260ee893ebSBruce Evans loadandclear(u_int *addr) 2270ee893ebSBruce Evans { 2280ee893ebSBruce Evans u_int result; 2290ee893ebSBruce Evans 2300ee893ebSBruce Evans __asm __volatile("xorl %0,%0; xchgl %1,%0" 23130fd0561SDavid Greenman : "=&r" (result) : "m" (*addr)); 2320ee893ebSBruce Evans return (result); 2330ee893ebSBruce Evans } 2340ee893ebSBruce Evans 235004bedebSBruce Evans static __inline void 236004bedebSBruce Evans outbv(u_int port, u_char data) 237004bedebSBruce Evans { 238004bedebSBruce Evans u_char al; 239004bedebSBruce Evans /* 240004bedebSBruce Evans * Use an unnecessary assignment to help gcc's register allocator. 241004bedebSBruce Evans * This make a large difference for gcc-1.40 and a tiny difference 242004bedebSBruce Evans * for gcc-2.6.0. For gcc-1.40, al had to be ``asm("ax")'' for 243004bedebSBruce Evans * best results. gcc-2.6.0 can't handle this. 244004bedebSBruce Evans */ 245004bedebSBruce Evans al = data; 246004bedebSBruce Evans __asm __volatile("outb %0,%%dx" : : "a" (al), "d" (port)); 247004bedebSBruce Evans } 248004bedebSBruce Evans 249004bedebSBruce Evans static __inline void 250004bedebSBruce Evans outl(u_int port, u_long data) 251004bedebSBruce Evans { 252004bedebSBruce Evans /* 253004bedebSBruce Evans * outl() and outw() aren't used much so we haven't looked at 254004bedebSBruce Evans * possible micro-optimizations such as the unnecessary 255004bedebSBruce Evans * assignment for them. 256004bedebSBruce Evans */ 257004bedebSBruce Evans __asm __volatile("outl %0,%%dx" : : "a" (data), "d" (port)); 258004bedebSBruce Evans } 259004bedebSBruce Evans 260004bedebSBruce Evans static __inline void 261004bedebSBruce Evans outsb(u_int port, void *addr, size_t cnt) 262004bedebSBruce Evans { 263004bedebSBruce Evans __asm __volatile("cld; rep; outsb" 264004bedebSBruce Evans : : "d" (port), "S" (addr), "c" (cnt) 265b5ba45f6SDavid Greenman : "si", "cx"); 266004bedebSBruce Evans } 267004bedebSBruce Evans 268004bedebSBruce Evans static __inline void 269004bedebSBruce Evans outsw(u_int port, void *addr, size_t cnt) 270004bedebSBruce Evans { 271004bedebSBruce Evans __asm __volatile("cld; rep; outsw" 272004bedebSBruce Evans : : "d" (port), "S" (addr), "c" (cnt) 273b5ba45f6SDavid Greenman : "si", "cx"); 274004bedebSBruce Evans } 275004bedebSBruce Evans 276004bedebSBruce Evans static __inline void 277004bedebSBruce Evans outsl(u_int port, void *addr, size_t cnt) 278004bedebSBruce Evans { 279004bedebSBruce Evans __asm __volatile("cld; rep; outsl" 280004bedebSBruce Evans : : "d" (port), "S" (addr), "c" (cnt) 281b5ba45f6SDavid Greenman : "si", "cx"); 282004bedebSBruce Evans } 283004bedebSBruce Evans 284004bedebSBruce Evans static __inline void 285004bedebSBruce Evans outw(u_int port, u_short data) 286004bedebSBruce Evans { 287004bedebSBruce Evans __asm __volatile("outw %0,%%dx" : : "a" (data), "d" (port)); 288004bedebSBruce Evans } 289004bedebSBruce Evans 290004bedebSBruce Evans static __inline u_long 291004bedebSBruce Evans rcr2(void) 292004bedebSBruce Evans { 293004bedebSBruce Evans u_long data; 294004bedebSBruce Evans 295004bedebSBruce Evans __asm __volatile("movl %%cr2,%0" : "=r" (data)); 296004bedebSBruce Evans return (data); 297004bedebSBruce Evans } 298004bedebSBruce Evans 299004bedebSBruce Evans static __inline u_long 300004bedebSBruce Evans read_eflags(void) 3015b81b6b3SRodney W. Grimes { 3028db02de8SPaul Richards u_long ef; 303004bedebSBruce Evans 304004bedebSBruce Evans __asm __volatile("pushfl; popl %0" : "=r" (ef)); 3058db02de8SPaul Richards return (ef); 3065b81b6b3SRodney W. Grimes } 3075b81b6b3SRodney W. Grimes 3085dbd168eSBruce Evans static __inline quad_t 3095dbd168eSBruce Evans rdmsr(u_int msr) 3105dbd168eSBruce Evans { 3115dbd168eSBruce Evans quad_t rv; 3125dbd168eSBruce Evans 3135dbd168eSBruce Evans __asm __volatile(".byte 0x0f, 0x32" : "=A" (rv) : "c" (msr)); 3145dbd168eSBruce Evans return (rv); 3155dbd168eSBruce Evans } 3165dbd168eSBruce Evans 3175dbd168eSBruce Evans static __inline quad_t 3185dbd168eSBruce Evans rdpmc(u_int pmc) 3195dbd168eSBruce Evans { 3205dbd168eSBruce Evans quad_t rv; 3215dbd168eSBruce Evans 3225dbd168eSBruce Evans __asm __volatile(".byte 0x0f, 0x33" : "=A" (rv) : "c" (pmc)); 3235dbd168eSBruce Evans return (rv); 3245dbd168eSBruce Evans } 3255dbd168eSBruce Evans 3265dbd168eSBruce Evans static __inline quad_t 3275dbd168eSBruce Evans rdtsc(void) 3285dbd168eSBruce Evans { 3295dbd168eSBruce Evans quad_t rv; 3305dbd168eSBruce Evans 3315dbd168eSBruce Evans __asm __volatile(".byte 0x0f, 0x31" : "=A" (rv)); 3325dbd168eSBruce Evans return (rv); 3335dbd168eSBruce Evans } 3345dbd168eSBruce Evans 335004bedebSBruce Evans static __inline void 3367baccf64SBruce Evans setbits(volatile unsigned *addr, u_int bits) 3377baccf64SBruce Evans { 3387baccf64SBruce Evans __asm __volatile("orl %1,%0" : "=m" (*addr) : "ir" (bits)); 3397baccf64SBruce Evans } 3407baccf64SBruce Evans 3417baccf64SBruce Evans static __inline void 3428db02de8SPaul Richards write_eflags(u_long ef) 3435b81b6b3SRodney W. Grimes { 344004bedebSBruce Evans __asm __volatile("pushl %0; popfl" : : "r" (ef)); 3455b81b6b3SRodney W. Grimes } 3465b81b6b3SRodney W. Grimes 347d69e8502SGarrett Wollman static __inline void 3485dbd168eSBruce Evans wrmsr(u_int msr, quad_t newval) 349d69e8502SGarrett Wollman { 35028dc3d27SGarrett Wollman __asm __volatile(".byte 0x0f, 0x30" : : "A" (newval), "c" (msr)); 351d69e8502SGarrett Wollman } 352d69e8502SGarrett Wollman 353004bedebSBruce Evans #else /* !__GNUC__ */ 3545b81b6b3SRodney W. Grimes 3555dbd168eSBruce Evans int breakpoint __P((void)); 3565b81b6b3SRodney W. Grimes void disable_intr __P((void)); 3575b81b6b3SRodney W. Grimes void enable_intr __P((void)); 3585b81b6b3SRodney W. Grimes u_char inb __P((u_int port)); 359004bedebSBruce Evans u_long inl __P((u_int port)); 360004bedebSBruce Evans void insb __P((u_int port, void *addr, size_t cnt)); 361004bedebSBruce Evans void insl __P((u_int port, void *addr, size_t cnt)); 362004bedebSBruce Evans void insw __P((u_int port, void *addr, size_t cnt)); 363ece15d78SBruce Evans void invlpg __P((u_int addr)); 364ece15d78SBruce Evans void invltlb __P((void)); 365004bedebSBruce Evans u_short inw __P((u_int port)); 3660ee893ebSBruce Evans u_int loadandclear __P((u_int *addr)); 367004bedebSBruce Evans void outb __P((u_int port, u_char data)); 368004bedebSBruce Evans void outl __P((u_int port, u_long data)); 369004bedebSBruce Evans void outsb __P((u_int port, void *addr, size_t cnt)); 370004bedebSBruce Evans void outsl __P((u_int port, void *addr, size_t cnt)); 371004bedebSBruce Evans void outsw __P((u_int port, void *addr, size_t cnt)); 372004bedebSBruce Evans void outw __P((u_int port, u_short data)); 373004bedebSBruce Evans u_long rcr2 __P((void)); 3745dbd168eSBruce Evans quad_t rdmsr __P((u_int msr)); 3755dbd168eSBruce Evans quad_t rdpmc __P((u_int pmc)); 376d69e8502SGarrett Wollman quad_t rdtsc __P((void)); 3775dbd168eSBruce Evans u_long read_eflags __P((void)); 3787baccf64SBruce Evans void setbits __P((volatile unsigned *addr, u_int bits)); 3795dbd168eSBruce Evans void write_eflags __P((u_long ef)); 3805dbd168eSBruce Evans void wrmsr __P((u_int msr, quad_t newval)); 381004bedebSBruce Evans 3825b81b6b3SRodney W. Grimes #endif /* __GNUC__ */ 3835b81b6b3SRodney W. Grimes 384004bedebSBruce Evans void load_cr0 __P((u_long cr0)); 385004bedebSBruce Evans void load_cr3 __P((u_long cr3)); 386004bedebSBruce Evans void ltr __P((u_short sel)); 387aaf08d94SGarrett Wollman u_int rcr0 __P((void)); 388004bedebSBruce Evans u_long rcr3 __P((void)); 3895b81b6b3SRodney W. Grimes 3907baccf64SBruce Evans #include <machine/spl.h> /* XXX belongs elsewhere */ 3917baccf64SBruce Evans 392004bedebSBruce Evans #endif /* !_MACHINE_CPUFUNC_H_ */ 393