]> git.ipfire.org Git - thirdparty/glibc.git/blobdiff - nptl/sysdeps/unix/sysv/linux/x86_64/lowlevellock.S
.
[thirdparty/glibc.git] / nptl / sysdeps / unix / sysv / linux / x86_64 / lowlevellock.S
index e7e1707a486f5657d349ea59d3b5314bf8963f42..394dec8d82a71b1dc748114ada96040464c62486 100644 (file)
@@ -1,4 +1,4 @@
-/* Copyright (C) 2002, 2003 Free Software Foundation, Inc.
+/* Copyright (C) 2002-2006, 2007 Free Software Foundation, Inc.
    This file is part of the GNU C Library.
    Contributed by Ulrich Drepper <drepper@redhat.com>, 2002.
 
@@ -18,6 +18,7 @@
    02111-1307 USA.  */
 
 #include <sysdep.h>
+#include <pthread-errnos.h>
 
        .text
 
 # endif
 #endif
 
-#define SYS_gettimeofday       __NR_gettimeofday
 #define SYS_futex              202
 #define FUTEX_WAIT             0
 #define FUTEX_WAKE             1
 
-#define ETIMEDOUT               110
+/* For the calculation see asm/vsyscall.h.  */
+#define VSYSCALL_ADDR_vgettimeofday    0xffffffffff600000
 
 
-       /* Modified: %rax, %rsi.  */
-       .globl  __lll_lock_wait
-       .type   __lll_lock_wait,@function
-       .hidden __lll_lock_wait
+       .globl  __lll_mutex_lock_wait
+       .type   __lll_mutex_lock_wait,@function
+       .hidden __lll_mutex_lock_wait
        .align  16
-__lll_lock_wait:
+__lll_mutex_lock_wait:
+       cfi_startproc
        pushq   %r10
+       cfi_adjust_cfa_offset(8)
        pushq   %rdx
-
+       cfi_adjust_cfa_offset(8)
+       cfi_offset(%r10, -16)
+       cfi_offset(%rdx, -24)
        xorq    %r10, %r10      /* No timeout.  */
+       movl    $2, %edx
+#if FUTEX_WAIT == 0
+       xorl    %esi, %esi
+#else
+       movl    $FUTEX_WAIT, %esi
+#endif
 
-1:
-       leal    -1(%esi), %edx  /* account for the preceeded xadd.  */
-       movq    %r10, %rsi      /* movl $FUTEX_WAIT, %ecx */
-       movq    $SYS_futex, %rax
+       cmpl    %edx, %eax      /* NB:   %edx == 2 */
+       jne     2f
+
+1:     movl    $SYS_futex, %eax
        syscall
 
-       orl     $-1, %esi       /* Load -1.  */
-       LOCK
-       xaddl   %esi, (%rdi)
-       jne,pn  1b
+2:     movl    %edx, %eax
+       xchgl   %eax, (%rdi)    /* NB:   lock is implied */
 
-       movl    $-1, (%rdi)
+       testl   %eax, %eax
+       jnz     1b
 
        popq    %rdx
+       cfi_adjust_cfa_offset(-8)
+       cfi_restore(%rdx)
        popq    %r10
+       cfi_adjust_cfa_offset(-8)
+       cfi_restore(%r10)
+       retq
+       cfi_endproc
+       .size   __lll_mutex_lock_wait,.-__lll_mutex_lock_wait
+
+
+#ifdef NOT_IN_libc
+       .globl  __lll_mutex_timedlock_wait
+       .type   __lll_mutex_timedlock_wait,@function
+       .hidden __lll_mutex_timedlock_wait
+       .align  16
+__lll_mutex_timedlock_wait:
+       cfi_startproc
+       /* Check for a valid timeout value.  */
+       cmpq    $1000000000, 8(%rdx)
+       jae     3f
+
+       pushq   %r8
+       cfi_adjust_cfa_offset(8)
+       pushq   %r9
+       cfi_adjust_cfa_offset(8)
+       pushq   %r12
+       cfi_adjust_cfa_offset(8)
+       pushq   %r13
+       cfi_adjust_cfa_offset(8)
+       pushq   %r14
+       cfi_adjust_cfa_offset(8)
+       cfi_offset(%r8, -16)
+       cfi_offset(%r9, -24)
+       cfi_offset(%r12, -32)
+       cfi_offset(%r13, -40)
+       cfi_offset(%r14, -48)
+
+       /* Stack frame for the timespec and timeval structs.  */
+       subq    $16, %rsp
+       cfi_adjust_cfa_offset(16)
+
+       movq    %rdi, %r12
+       movq    %rdx, %r13
+
+1:
+       /* Get current time.  */
+       movq    %rsp, %rdi
+       xorl    %esi, %esi
+       movq    $VSYSCALL_ADDR_vgettimeofday, %rax
+       /* This is a regular function call, all caller-save registers
+          might be clobbered.  */
+       callq   *%rax
+
+       /* Compute relative timeout.  */
+       movq    8(%rsp), %rax
+       movl    $1000, %edi
+       mul     %rdi            /* Milli seconds to nano seconds.  */
+       movq    (%r13), %rdi
+       movq    8(%r13), %rsi
+       subq    (%rsp), %rdi
+       subq    %rax, %rsi
+       jns     4f
+       addq    $1000000000, %rsi
+       decq    %rdi
+4:     testq   %rdi, %rdi
+       js      5f              /* Time is already up.  */
+
+       /* Futex call.  */
+       movq    %rdi, (%rsp)    /* Store relative timeout.  */
+       movq    %rsi, 8(%rsp)
+
+       movl    $1, %eax
+       movl    $2, %edx
+       LOCK
+       cmpxchgl %edx, (%r12)
+
+       testl   %eax, %eax
+       je      8f
+
+       movq    %rsp, %r10
+#if FUTEX_WAIT == 0
+       xorl    %esi, %esi
+#else
+       movl    $FUTEX_WAIT, %esi
+#endif
+       movq    %r12, %rdi
+       movl    $SYS_futex, %eax
+       syscall
+       movq    %rax, %rcx
+
+8:                             /* NB: %edx == 2 */
+       xorl    %eax, %eax
+       LOCK
+       cmpxchgl %edx, (%r12)
+       jnz     7f
+
+6:     addq    $16, %rsp
+       cfi_adjust_cfa_offset(-16)
+       popq    %r14
+       cfi_adjust_cfa_offset(-8)
+       cfi_restore(%r14)
+       popq    %r13
+       cfi_adjust_cfa_offset(-8)
+       cfi_restore(%r13)
+       popq    %r12
+       cfi_adjust_cfa_offset(-8)
+       cfi_restore(%r12)
+       popq    %r9
+       cfi_adjust_cfa_offset(-8)
+       cfi_restore(%r9)
+       popq    %r8
+       cfi_adjust_cfa_offset(-8)
+       cfi_restore(%r8)
        retq
-       .size   __lll_lock_wait,.-__lll_lock_wait
+
+3:     movl    $EINVAL, %eax
+       retq
+
+       cfi_adjust_cfa_offset(56)
+       cfi_offset(%r8, -16)
+       cfi_offset(%r9, -24)
+       cfi_offset(%r12, -32)
+       cfi_offset(%r13, -40)
+       cfi_offset(%r14, -48)
+       /* Check whether the time expired.  */
+7:     cmpq    $-ETIMEDOUT, %rcx
+       je      5f
+
+       /* Make sure the current holder knows we are going to sleep.  */
+       movl    %edx, %eax
+       xchgl   %eax, (%rdi)
+       testl   %eax, %eax
+       jz      6b
+       jmp     1b
+
+5:     movl    $ETIMEDOUT, %eax
+       jmp     6b
+       cfi_endproc
+       .size   __lll_mutex_timedlock_wait,.-__lll_mutex_timedlock_wait
+#endif
 
 
 #ifdef NOT_IN_libc
@@ -87,24 +233,34 @@ lll_unlock_wake_cb:
 #endif
 
 
-       .globl  __lll_unlock_wake
-       .type   __lll_unlock_wake,@function
-       .hidden __lll_unlock_wake
+       .globl  __lll_mutex_unlock_wake
+       .type   __lll_mutex_unlock_wake,@function
+       .hidden __lll_mutex_unlock_wake
        .align  16
-__lll_unlock_wake:
+__lll_mutex_unlock_wake:
+       cfi_startproc
        pushq   %rsi
+       cfi_adjust_cfa_offset(8)
        pushq   %rdx
+       cfi_adjust_cfa_offset(8)
+       cfi_offset(%rsi, -16)
+       cfi_offset(%rdx, -24)
 
-1:     movq    $FUTEX_WAKE, %rsi
+       movl    $0, (%rdi)
+       movl    $FUTEX_WAKE, %esi
        movl    $1, %edx        /* Wake one thread.  */
-       movq    $SYS_futex, %rax
-       movl    %edx, (%rdi)    /* Stores '$1'.  */
+       movl    $SYS_futex, %eax
        syscall
 
        popq    %rdx
+       cfi_adjust_cfa_offset(-8)
+       cfi_restore(%rdx)
        popq    %rsi
+       cfi_adjust_cfa_offset(-8)
+       cfi_restore(%rsi)
        retq
-       .size   __lll_unlock_wake,.-__lll_unlock_wake
+       cfi_endproc
+       .size   __lll_mutex_unlock_wake,.-__lll_mutex_unlock_wake
 
 
 #ifdef NOT_IN_libc
@@ -113,23 +269,26 @@ __lll_unlock_wake:
        .hidden __lll_timedwait_tid
        .align  16
 __lll_timedwait_tid:
-       movl    %rdi, %r8
-       movl    %rsi, %r9
+       pushq   %r12
+       pushq   %r13
+
+       movq    %rdi, %r12
+       movq    %rsi, %r13
 
        subq    $16, %rsp
 
        /* Get current time.  */
 2:     movq    %rsp, %rdi
-       xorq    %rsi, %rsi
-       movq    $SYS_gettimeofday, %rax
-       syscall
+       xorl    %esi, %esi
+       movq    $VSYSCALL_ADDR_vgettimeofday, %rax
+       callq   *%rax
 
        /* Compute relative timeout.  */
-       movq    8(%esp), %rax
-       movq    $1000, %rdi
+       movq    8(%rsp), %rax
+       movl    $1000, %edi
        mul     %rdi            /* Milli seconds to nano seconds.  */
-       movq    (%r9), %rdi
-       movq    8(%r9), %rsi
+       movq    (%r13), %rdi
+       movq    8(%r13), %rsi
        subq    (%rsp), %rdi
        subq    %rax, %rsi
        jns     5f
@@ -141,28 +300,33 @@ __lll_timedwait_tid:
        movq    %rdi, (%rsp)    /* Store relative timeout.  */
        movq    %rsi, 8(%rsp)
 
-       movl    (%r8), %edx
+       movl    (%r12), %edx
        testl   %edx, %edx
        jz      4f
 
        movq    %rsp, %r10
-       xorq    %rsi, %rsi      /* movl $FUTEX_WAIT, %ecx */
-       movq    %r8, %rdi
-       movq    $SYS_futex, %rax
+#if FUTEX_WAIT == 0
+       xorl    %esi, %esi
+#else
+       movl    $FUTEX_WAIT, %esi
+#endif
+       movq    %r12, %rdi
+       movl    $SYS_futex, %eax
        syscall
 
        cmpl    $0, (%rdi)
        jne     1f
 4:     xorl    %eax, %eax
 
-       addq    $16, %rsp
+8:     addq    $16, %rsp
+       popq    %r13
+       popq    %r12
        retq
 
 1:     cmpq    $-ETIMEDOUT, %rax
        jne     2b
 
 6:     movl    $ETIMEDOUT, %eax
-       addq    $16, %rsp
-       retq
+       jmp     8b
        .size   __lll_timedwait_tid,.-__lll_timedwait_tid
 #endif