posix: pthread_testcancel #59946

Implement posix pthread_testcancel()

signed-off-by: Gaetan Perrot <[email protected]>

Author: moonlight83340

include/zephyr/posix/pthread.h

@@ -440,6 +440,7 @@ int pthread_create(pthread_t *newthread, const pthread_attr_t *attr,
 		   void *(*threadroutine)(void *), void *arg);
 int pthread_setcancelstate(int state, int *oldstate);
 int pthread_setcanceltype(int type, int *oldtype);
+void pthread_testcancel(void);
 int pthread_attr_setschedparam(pthread_attr_t *attr,
 			       const struct sched_param *schedparam);
 int pthread_setschedparam(pthread_t pthread, int policy,

lib/posix/options/pthread.c

@@ -679,6 +679,35 @@ int pthread_setcanceltype(int type, int *oldtype)
 	return ret;
 }
 
+/**
+ * @brief Create a cancellation point in the calling thread.
+ *
+ * See IEEE 1003.1
+ */
+void pthread_testcancel(void)
+{
+	struct posix_thread *t;
+	bool cancel_pended = false;
+
+	K_SPINLOCK(&pthread_pool_lock) {
+		t = to_posix_thread(pthread_self());
+		if (t == NULL) {
+			K_SPINLOCK_BREAK;
+		}
+		if (t->attr.cancelstate != PTHREAD_CANCEL_ENABLE) {
+			K_SPINLOCK_BREAK;
+		}
+		if (t->attr.cancelpending) {
+			cancel_pended = true;
+			t->attr.cancelstate = PTHREAD_CANCEL_DISABLE;
+		}
+	}
+
+	if (cancel_pended) {
+		posix_thread_finalize(t, PTHREAD_CANCELED);
+	}
+}
+
 /**
  * @brief Cancel execution of a thread.
  *