X-Git-Url: http://nsz.repo.hu/git/?p=musl;a=blobdiff_plain;f=src%2Fthread%2Fpthread_mutex_trylock.c;h=4a424bc91a4217e869fe29c55f6ddd681eb85e63;hp=7ff4f703b9ff1e68bc365a2bf31e64fdd6faa278;hb=c68de0be2fb649f91b31080224fb6e48084eaaee;hpb=4820f9268d3dc1f2aac923de0a591ffd5d54ea89

diff --git a/src/thread/pthread_mutex_trylock.c b/src/thread/pthread_mutex_trylock.c
index 7ff4f703..4a424bc9 100644
--- a/src/thread/pthread_mutex_trylock.c
+++ b/src/thread/pthread_mutex_trylock.c
@@ -2,24 +2,52 @@
 
 int pthread_mutex_trylock(pthread_mutex_t *m)
 {
+	int tid, old, own;
 	pthread_t self;
-	if (m->_m_type != PTHREAD_MUTEX_NORMAL) {
-		self = pthread_self();
-		if (m->_m_type == PTHREAD_MUTEX_RECURSIVE
-		 && m->_m_owner == self->tid) {
-			if ((unsigned)m->_m_count >= INT_MAX) return EAGAIN;
-			m->_m_count++;
-			return 0;
-		}
+
+	if (m->_m_type == PTHREAD_MUTEX_NORMAL)
+		return a_cas(&m->_m_lock, 0, EBUSY) & EBUSY;
+
+	self = pthread_self();
+	tid = self->tid;
+
+	if (m->_m_type >= 4) {
+		if (!self->robust_list.off)
+			__syscall(SYS_set_robust_list,
+				&self->robust_list, 3*sizeof(long));
+		self->robust_list.off = (char*)&m->_m_lock-(char *)&m->_m_next;
+		self->robust_list.pending = &m->_m_next;
+	}
+
+	old = m->_m_lock;
+	own = old & 0x7fffffff;
+	if (own == tid && (m->_m_type&3) == PTHREAD_MUTEX_RECURSIVE) {
+		if ((unsigned)m->_m_count >= INT_MAX) return EAGAIN;
+		m->_m_count++;
+		return 0;
 	}
 
-	if (a_xchg(&m->_m_lock, 1))
-		if (m->_m_type == PTHREAD_MUTEX_ERRORCHECK
-		 && m->_m_owner == self->tid) return EDEADLK;
-		else return EBUSY;
-	if (m->_m_type != PTHREAD_MUTEX_NORMAL) {
-		m->_m_owner = self->tid;
-		m->_m_count = 1;
+	if ((own && !(own & 0x40000000)) || a_cas(&m->_m_lock, old, tid)!=old)
+		return EBUSY;
+
+	m->_m_count = 1;
+
+	if (m->_m_type < 4) return 0;
+
+	if (m->_m_type >= 8) {
+		m->_m_lock = 0;
+		return ENOTRECOVERABLE;
 	}
+	m->_m_next = self->robust_list.head;
+	m->_m_prev = &self->robust_list.head;
+	if (self->robust_list.head)
+		self->robust_list.head[-1] = &m->_m_next;
+	self->robust_list.head = &m->_m_next;
+	self->robust_list.pending = 0;
+	if (own) {
+		m->_m_type += 8;
+		return EOWNERDEAD;
+	}
+
 	return 0;
 }