ea2630c632
2003-05-28 Kaz Kojima <kkojima@rr.iij4u.or.jp>
* sysdeps/sh/tcb-offsets.sym: Define MUTEX_FUTEX.
* sysdeps/unix/sysv/linux/sh/bits/pthreadtypes.h (pthread_cond_t):
Add __mutex field.
* sysdeps/unix/sysv/linux/sh/lowlevellock.h (SYSCALL_WITH_INST_PAD):
Define.
(lll_futex_wait, lll_futex_wake): Define.
* sysdeps/unix/sysv/linux/sh/sh4/lowlevellock.h: New file.
* sysdeps/unix/sysv/linux/sh/pthread_cond_broadcast.S: Try using
FUTEX_REQUEUE instead of FUTEX_WAIT.
* sysdeps/unix/sysv/linux/sh/pthread_cond_signal.S: Likewise.
* sysdeps/unix/sysv/linux/sh/pthread_cond_timedwait.S: Remember
mutex which was used in condvar structure. Call
__pthread_mutex_cond_lock instead of __pthread_mutex_lock_internal.
* sysdeps/unix/sysv/linux/sh/pthread_cond_wait.S: Likewise.
* sysdeps/unix/sysv/linux/sh/pthread_rwlock_rdlock.S: Don't
include tcb-offsets.h. Read wakeup value in locked region.
Use the value of gbr register as THREAD_ID.
* sysdeps/unix/sysv/linux/sh/pthread_rwlock_wrlock.S: Likewise.
* sysdeps/unix/sysv/linux/sh/pthread_rwlock_timedrdlock.S: Likewise.
* sysdeps/unix/sysv/linux/sh/pthread_rwlock_timedwrlock.S: Likewise.
* sysdeps/unix/sysv/linux/sh/sem_trywait.S: Remove futex related
macros.
398 lines
6.7 KiB
ArmAsm
398 lines
6.7 KiB
ArmAsm
/* Copyright (C) 2003 Free Software Foundation, Inc.
|
|
This file is part of the GNU C Library.
|
|
|
|
The GNU C Library is free software; you can redistribute it and/or
|
|
modify it under the terms of the GNU Lesser General Public
|
|
License as published by the Free Software Foundation; either
|
|
version 2.1 of the License, or (at your option) any later version.
|
|
|
|
The GNU C Library is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
Lesser General Public License for more details.
|
|
|
|
You should have received a copy of the GNU Lesser General Public
|
|
License along with the GNU C Library; if not, write to the Free
|
|
Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
|
|
02111-1307 USA. */
|
|
|
|
#include <sysdep.h>
|
|
#include <shlib-compat.h>
|
|
#include <lowlevelcond.h>
|
|
#include <pthread-errnos.h>
|
|
#include "lowlevel-atomic.h"
|
|
|
|
#define SYS_gettimeofday __NR_gettimeofday
|
|
#define SYS_futex 240
|
|
#define FUTEX_WAIT 0
|
|
#define FUTEX_WAKE 1
|
|
|
|
|
|
.text
|
|
|
|
/* int pthread_cond_timedwait (pthread_cond_t *cond, pthread_mutex_t *mutex,
|
|
const struct timespec *abstime) */
|
|
.globl __pthread_cond_timedwait
|
|
.type __pthread_cond_timedwait, @function
|
|
.align 5
|
|
__pthread_cond_timedwait:
|
|
mov.l r12, @-r15
|
|
mov.l r10, @-r15
|
|
mov.l r9, @-r15
|
|
mov.l r8, @-r15
|
|
sts.l pr, @-r15
|
|
add #-64, r15
|
|
mov r4, r8
|
|
mov r5, r9
|
|
mov r6, r10
|
|
|
|
/* Get internal lock. */
|
|
mov #1, r3
|
|
#if cond_lock != 0
|
|
XADD (r3, @(cond_lock,r8), r2)
|
|
#else
|
|
XADD (r3, @r8, r2)
|
|
#endif
|
|
tst r2, r2
|
|
bt 2f
|
|
bra 1f
|
|
nop
|
|
2:
|
|
/* Store the reference to the mutex. If there is already a
|
|
different value in there this is a bad user bug. */
|
|
mov.l r9, @(dep_mutex,r8)
|
|
|
|
/* Unlock the mutex. */
|
|
mov.l .Lmunlock1, r1
|
|
bsrf r1
|
|
mov r9, r4
|
|
.Lmunlock1b:
|
|
|
|
tst r0, r0
|
|
bf 16f
|
|
|
|
mov #1, r2
|
|
mov #0, r3
|
|
|
|
clrt
|
|
mov.l @(total_seq,r8),r0
|
|
mov.l @(total_seq+4,r8),r1
|
|
addc r2, r0
|
|
addc r3, r1
|
|
mov.l r0,@(total_seq,r8)
|
|
mov.l r1,@(total_seq+4,r8)
|
|
|
|
/* Install cancellation handler. */
|
|
#ifdef PIC
|
|
mova .Lgot1, r0
|
|
mov.l .Lgot1, r12
|
|
add r0, r12
|
|
mov.l .Lccleanup1, r5
|
|
add r12, r5
|
|
#else
|
|
mov.l .Lccleanup1, r5
|
|
#endif
|
|
mov r15, r4
|
|
add #36, r4
|
|
|
|
mov.l .Lccpush1, r1
|
|
bsrf r1
|
|
mov r15, r6
|
|
.Lccpush1b:
|
|
|
|
/* Get and store current wakeup_seq value. */
|
|
mov.l @(wakeup_seq,r8), r0
|
|
mov.l @(wakeup_seq+4,r8), r1
|
|
mov.l r0, @(20,r15)
|
|
mov.l r1, @(24,r15)
|
|
/* Prepare structure passed to cancellation handler. */
|
|
mov.l r9, @r15
|
|
mov.l r8, @(4,r15)
|
|
|
|
/* Unlock. */
|
|
8:
|
|
#if cond_lock != 0
|
|
DEC (@(cond_lock,r8), r2)
|
|
#else
|
|
DEC (@r8, r2)
|
|
#endif
|
|
tst r2, r2
|
|
bt 4f
|
|
bra 3f
|
|
nop
|
|
4:
|
|
mov.l .Lenable1, r1
|
|
bsrf r1
|
|
nop
|
|
.Lenable1b:
|
|
mov.l r0, @(8,r15)
|
|
|
|
/* Get current time. */
|
|
mov r15, r4
|
|
add #12, r4
|
|
mov #0, r5
|
|
mov #SYS_gettimeofday, r3
|
|
trapa #0x12
|
|
SYSCALL_INST_PAD
|
|
|
|
/* Compute relative timeout. */
|
|
mov.l @(16,r15), r0
|
|
mov.w .L1k, r1
|
|
dmulu.l r0, r1 /* Milli seconds to nano seconds. */
|
|
mov.l @r10, r2
|
|
mov.l @(4,r10), r3
|
|
mov.l @(12,r15), r0
|
|
sts macl, r1
|
|
sub r0, r2
|
|
clrt
|
|
subc r1, r3
|
|
bf 12f
|
|
mov.l .L1g, r1
|
|
add r1, r3
|
|
add #-1, r2
|
|
12:
|
|
cmp/pz r2
|
|
bf 13f /* Time is already up. */
|
|
|
|
/* Store relative timeout. */
|
|
mov.l r2, @(12,r15)
|
|
mov.l r3, @(16,r15)
|
|
|
|
mov r15, r7
|
|
add #12, r7
|
|
mov #FUTEX_WAIT, r5
|
|
mov.l @(20,r15), r6
|
|
mov r8, r4
|
|
add #wakeup_seq, r4
|
|
mov #SYS_futex, r3
|
|
extu.b r3, r3
|
|
trapa #0x14
|
|
SYSCALL_INST_PAD
|
|
mov.l r0, @(28,r15)
|
|
|
|
mov.l .Ldisable1, r1
|
|
bsrf r1
|
|
mov.l @(8,r15), r4
|
|
.Ldisable1b:
|
|
|
|
/* Lock. */
|
|
mov #1, r3
|
|
#if cond_lock != 0
|
|
XADD (r3, @(cond_lock,r8), r2)
|
|
#else
|
|
XADD (r3, @r8, r2)
|
|
#endif
|
|
tst r2, r2
|
|
bf 5f
|
|
6:
|
|
mov.l @(woken_seq,r8), r0
|
|
mov.l @(woken_seq+4,r8), r1
|
|
|
|
mov.l @(wakeup_seq,r8), r2
|
|
mov.l @(wakeup_seq+4,r8), r3
|
|
|
|
mov.l @(24,r15), r5
|
|
cmp/hi r5, r3
|
|
bt 7f
|
|
cmp/hi r3, r5
|
|
bt 15f
|
|
|
|
mov.l @(20,r15), r5
|
|
cmp/hs r2, r5
|
|
bt 15f
|
|
7:
|
|
cmp/hi r1, r3
|
|
bt 9f
|
|
cmp/hi r3, r1
|
|
bt 15f
|
|
cmp/hi r0, r2
|
|
bt 9f
|
|
15:
|
|
mov.l @(28,r15),r0
|
|
cmp/eq #-ETIMEDOUT, r0
|
|
bf 8b
|
|
13:
|
|
mov #1, r2
|
|
mov #0, r3
|
|
|
|
clrt
|
|
mov.l @(wakeup_seq,r8),r0
|
|
mov.l @(wakeup_seq+4,r8),r1
|
|
addc r2, r0
|
|
addc r3, r1
|
|
mov.l r0,@(wakeup_seq,r8)
|
|
mov.l r1,@(wakeup_seq+4,r8)
|
|
mov #ETIMEDOUT, r0
|
|
bra 14f
|
|
mov.l r0, @(32,r15)
|
|
|
|
9:
|
|
mov #0, r0
|
|
mov.l r0, @(32,r15)
|
|
14:
|
|
mov #1, r2
|
|
mov #0, r3
|
|
|
|
clrt
|
|
mov.l @(woken_seq,r8),r0
|
|
mov.l @(woken_seq+4,r8),r1
|
|
addc r2, r0
|
|
addc r3, r1
|
|
mov.l r0,@(woken_seq,r8)
|
|
mov.l r1,@(woken_seq+4,r8)
|
|
|
|
#if cond_lock != 0
|
|
DEC (@(cond_lock,r8), r2)
|
|
#else
|
|
DEC (@r8, r2)
|
|
#endif
|
|
tst r2, r2
|
|
bf 10f
|
|
|
|
11:
|
|
/* Remove cancellation handler. */
|
|
mov r15, r4
|
|
add #36, r4
|
|
mov.l .Lcpop1, r1
|
|
bsrf r1
|
|
mov #0, r5
|
|
.Lcpop1b:
|
|
|
|
mov r9, r4
|
|
mov.l .Lmlocki1, r1
|
|
bsrf r1
|
|
nop
|
|
.Lmlocki1b:
|
|
|
|
/* We return the result of the mutex_lock operation if it failed. */
|
|
tst r0, r0
|
|
bf 18f
|
|
mov.l @(32,r15), r0
|
|
|
|
18:
|
|
add #64, r15
|
|
lds.l @r15+, pr
|
|
mov.l @r15+, r8
|
|
mov.l @r15+, r9
|
|
mov.l @r15+, r10
|
|
rts
|
|
mov.l @r15+, r12
|
|
ret
|
|
|
|
.L1k:
|
|
.word 1000
|
|
.align 2
|
|
.Lmunlock1:
|
|
.long __pthread_mutex_unlock_internal-.Lmunlock1b
|
|
#ifdef PIC
|
|
.Lgot1:
|
|
.long _GLOBAL_OFFSET_TABLE_
|
|
.Lccleanup1:
|
|
.long __condvar_cleanup@GOTOFF
|
|
#else
|
|
.Lccleanup1:
|
|
.long __condvar_cleanup
|
|
#endif
|
|
.Lccpush1:
|
|
.long __pthread_cleanup_push-.Lccpush1b
|
|
.Lenable1:
|
|
.long __pthread_enable_asynccancel-.Lenable1b
|
|
.Ldisable1:
|
|
.long __pthread_disable_asynccancel-.Ldisable1b
|
|
.Lcpop1:
|
|
.long __pthread_cleanup_pop-.Lcpop1b
|
|
.Lmlocki1:
|
|
.long __pthread_mutex_cond_lock-.Lmlocki1b
|
|
.L1g:
|
|
.long 1000000000
|
|
|
|
1:
|
|
/* Initial locking failed. */
|
|
mov r8, r5
|
|
#if cond_lock != 0
|
|
add #cond_lock, r5
|
|
#endif
|
|
mov.l .Lmwait2, r1
|
|
bsrf r1
|
|
mov r2, r4
|
|
.Lmwait2b:
|
|
bra 2b
|
|
nop
|
|
|
|
3:
|
|
/* Unlock in loop requires waekup. */
|
|
mov r8, r4
|
|
#if cond_lock != 0
|
|
add #cond_lock, r4
|
|
#endif
|
|
mov.l .Lmwake2, r1
|
|
bsrf r1
|
|
nop
|
|
.Lmwake2b:
|
|
bra 4b
|
|
nop
|
|
|
|
5:
|
|
/* Locking in loop failed. */
|
|
mov r8, r5
|
|
#if cond_lock != 0
|
|
add #cond_lock, r5
|
|
#endif
|
|
mov.l .Lmwait3, r1
|
|
bsrf r1
|
|
mov r2, r4
|
|
.Lmwait3b:
|
|
bra 6b
|
|
nop
|
|
|
|
10:
|
|
/* Unlock after loop requires waekup. */
|
|
mov r8, r4
|
|
#if cond_lock != 0
|
|
add #cond_lock, r4
|
|
#endif
|
|
mov.l .Lmwake3, r1
|
|
bsrf r1
|
|
nop
|
|
.Lmwake3b:
|
|
bra 11b
|
|
nop
|
|
|
|
16:
|
|
/* The initial unlocking of the mutex failed. */
|
|
mov.l r0, @(32,r15)
|
|
#if cond_lock != 0
|
|
DEC (@(cond_lock,r8), r2)
|
|
#else
|
|
DEC (@r8, r2)
|
|
#endif
|
|
tst r2, r2
|
|
bf 17f
|
|
|
|
mov r8, r4
|
|
#if cond_lock != 0
|
|
add #cond_lock, r4
|
|
#endif
|
|
mov.l .Lmwake4, r1
|
|
bsrf r1
|
|
nop
|
|
.Lmwake4b:
|
|
17:
|
|
bra 18b
|
|
mov.l @(32,r15), r0
|
|
|
|
.align 2
|
|
.Lmwait2:
|
|
.long __lll_mutex_lock_wait-.Lmwait2b
|
|
.Lmwake2:
|
|
.long __lll_mutex_unlock_wake-.Lmwake2b
|
|
.Lmwait3:
|
|
.long __lll_mutex_lock_wait-.Lmwait3b
|
|
.Lmwake3:
|
|
.long __lll_mutex_unlock_wake-.Lmwake3b
|
|
.Lmwake4:
|
|
.long __lll_mutex_unlock_wake-.Lmwake4b
|
|
.size __pthread_cond_timedwait, .-__pthread_cond_timedwait
|
|
versioned_symbol (libpthread, __pthread_cond_timedwait, pthread_cond_timedwait,
|
|
GLIBC_2_3_2)
|