__vdso_gettc.c revision 286284
1237434Skib/*- 2237434Skib * Copyright (c) 2012 Konstantin Belousov <kib@FreeBSD.org> 3237434Skib * 4237434Skib * Redistribution and use in source and binary forms, with or without 5237434Skib * modification, are permitted provided that the following conditions 6237434Skib * are met: 7237434Skib * 1. Redistributions of source code must retain the above copyright 8237434Skib * notice, this list of conditions and the following disclaimer. 9237434Skib * 2. Redistributions in binary form must reproduce the above copyright 10237434Skib * notice, this list of conditions and the following disclaimer in the 11237434Skib * documentation and/or other materials provided with the distribution. 12237434Skib * 13237434Skib * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 14237434Skib * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 15237434Skib * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 16237434Skib * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 17237434Skib * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 18237434Skib * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 19237434Skib * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 20237434Skib * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 21237434Skib * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 22237434Skib * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 23237434Skib * SUCH DAMAGE. 24237434Skib */ 25237434Skib 26237434Skib#include <sys/cdefs.h> 27237434Skib__FBSDID("$FreeBSD: head/lib/libc/i386/sys/__vdso_gettc.c 286284 2015-08-04 12:33:51Z kib $"); 28237434Skib 29237434Skib#include <sys/types.h> 30246117Skib#include <sys/elf.h> 31237434Skib#include <sys/time.h> 32237434Skib#include <sys/vdso.h> 33237434Skib#include <machine/cpufunc.h> 34286284Skib#include <machine/specialreg.h> 35246117Skib#include "libc_private.h" 36237434Skib 37286284Skibstatic int lfence_works = -1; 38286284Skib 39286284Skibstatic int 40286284Skibget_lfence_usage(void) 41286284Skib{ 42286284Skib u_int cpuid_supported, p[4]; 43286284Skib 44286284Skib if (lfence_works == -1) { 45286284Skib __asm __volatile( 46286284Skib " pushfl\n" 47286284Skib " popl %%eax\n" 48286284Skib " movl %%eax,%%ecx\n" 49286284Skib " xorl $0x200000,%%eax\n" 50286284Skib " pushl %%eax\n" 51286284Skib " popfl\n" 52286284Skib " pushfl\n" 53286284Skib " popl %%eax\n" 54286284Skib " xorl %%eax,%%ecx\n" 55286284Skib " je 1f\n" 56286284Skib " movl $1,%0\n" 57286284Skib " jmp 2f\n" 58286284Skib "1: movl $0,%0\n" 59286284Skib "2:\n" 60286284Skib : "=r" (cpuid_supported) : : "eax", "ecx"); 61286284Skib if (cpuid_supported) { 62286284Skib __asm __volatile( 63286284Skib " pushl %%ebx\n" 64286284Skib " cpuid\n" 65286284Skib " movl %%ebx,%1\n" 66286284Skib " popl %%ebx\n" 67286284Skib : "=a" (p[0]), "=r" (p[1]), "=c" (p[2]), "=d" (p[3]) 68286284Skib : "0" (0x1)); 69286284Skib lfence_works = (p[3] & CPUID_SSE2) != 0; 70286284Skib } else 71286284Skib lfence_works = 0; 72286284Skib } 73286284Skib return (lfence_works); 74286284Skib} 75286284Skib 76237434Skibstatic u_int 77237434Skib__vdso_gettc_low(const struct vdso_timehands *th) 78237434Skib{ 79286284Skib u_int rv; 80237434Skib 81286284Skib if (get_lfence_usage() == 1) 82286284Skib lfence(); 83237434Skib __asm __volatile("rdtsc; shrd %%cl, %%edx, %0" 84237434Skib : "=a" (rv) : "c" (th->th_x86_shift) : "edx"); 85237434Skib return (rv); 86237434Skib} 87237434Skib 88286284Skibstatic u_int 89286284Skib__vdso_rdtsc32(void) 90286284Skib{ 91286284Skib u_int rv; 92286284Skib 93286284Skib if (get_lfence_usage() == 1) 94286284Skib lfence(); 95286284Skib rv = rdtsc32(); 96286284Skib return (rv); 97286284Skib} 98286284Skib 99237434Skib#pragma weak __vdso_gettc 100237434Skibu_int 101237434Skib__vdso_gettc(const struct vdso_timehands *th) 102237434Skib{ 103237434Skib 104286284Skib return (th->th_x86_shift > 0 ? __vdso_gettc_low(th) : 105286284Skib __vdso_rdtsc32()); 106237434Skib} 107246117Skib 108246117Skib#pragma weak __vdso_gettimekeep 109246117Skibint 110246117Skib__vdso_gettimekeep(struct vdso_timekeep **tk) 111246117Skib{ 112246117Skib 113246117Skib return (_elf_aux_info(AT_TIMEKEEP, tk, sizeof(*tk))); 114246117Skib} 115