162306a36Sopenharmony_ci/* Make sure timers don't return early
262306a36Sopenharmony_ci *              by: john stultz (johnstul@us.ibm.com)
362306a36Sopenharmony_ci *		    John Stultz (john.stultz@linaro.org)
462306a36Sopenharmony_ci *              (C) Copyright IBM 2012
562306a36Sopenharmony_ci *              (C) Copyright Linaro 2013 2015
662306a36Sopenharmony_ci *              Licensed under the GPLv2
762306a36Sopenharmony_ci *
862306a36Sopenharmony_ci *  To build:
962306a36Sopenharmony_ci *	$ gcc nanosleep.c -o nanosleep -lrt
1062306a36Sopenharmony_ci *
1162306a36Sopenharmony_ci *   This program is free software: you can redistribute it and/or modify
1262306a36Sopenharmony_ci *   it under the terms of the GNU General Public License as published by
1362306a36Sopenharmony_ci *   the Free Software Foundation, either version 2 of the License, or
1462306a36Sopenharmony_ci *   (at your option) any later version.
1562306a36Sopenharmony_ci *
1662306a36Sopenharmony_ci *   This program is distributed in the hope that it will be useful,
1762306a36Sopenharmony_ci *   but WITHOUT ANY WARRANTY; without even the implied warranty of
1862306a36Sopenharmony_ci *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
1962306a36Sopenharmony_ci *   GNU General Public License for more details.
2062306a36Sopenharmony_ci */
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_ci#include <errno.h>
2362306a36Sopenharmony_ci#include <stdio.h>
2462306a36Sopenharmony_ci#include <stdlib.h>
2562306a36Sopenharmony_ci#include <time.h>
2662306a36Sopenharmony_ci#include <sys/time.h>
2762306a36Sopenharmony_ci#include <sys/timex.h>
2862306a36Sopenharmony_ci#include <string.h>
2962306a36Sopenharmony_ci#include <signal.h>
3062306a36Sopenharmony_ci#include "../kselftest.h"
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_ci#define NSEC_PER_SEC 1000000000ULL
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_ci#define CLOCK_REALTIME			0
3562306a36Sopenharmony_ci#define CLOCK_MONOTONIC			1
3662306a36Sopenharmony_ci#define CLOCK_PROCESS_CPUTIME_ID	2
3762306a36Sopenharmony_ci#define CLOCK_THREAD_CPUTIME_ID		3
3862306a36Sopenharmony_ci#define CLOCK_MONOTONIC_RAW		4
3962306a36Sopenharmony_ci#define CLOCK_REALTIME_COARSE		5
4062306a36Sopenharmony_ci#define CLOCK_MONOTONIC_COARSE		6
4162306a36Sopenharmony_ci#define CLOCK_BOOTTIME			7
4262306a36Sopenharmony_ci#define CLOCK_REALTIME_ALARM		8
4362306a36Sopenharmony_ci#define CLOCK_BOOTTIME_ALARM		9
4462306a36Sopenharmony_ci#define CLOCK_HWSPECIFIC		10
4562306a36Sopenharmony_ci#define CLOCK_TAI			11
4662306a36Sopenharmony_ci#define NR_CLOCKIDS			12
4762306a36Sopenharmony_ci
4862306a36Sopenharmony_ci#define UNSUPPORTED 0xf00f
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_cichar *clockstring(int clockid)
5162306a36Sopenharmony_ci{
5262306a36Sopenharmony_ci	switch (clockid) {
5362306a36Sopenharmony_ci	case CLOCK_REALTIME:
5462306a36Sopenharmony_ci		return "CLOCK_REALTIME";
5562306a36Sopenharmony_ci	case CLOCK_MONOTONIC:
5662306a36Sopenharmony_ci		return "CLOCK_MONOTONIC";
5762306a36Sopenharmony_ci	case CLOCK_PROCESS_CPUTIME_ID:
5862306a36Sopenharmony_ci		return "CLOCK_PROCESS_CPUTIME_ID";
5962306a36Sopenharmony_ci	case CLOCK_THREAD_CPUTIME_ID:
6062306a36Sopenharmony_ci		return "CLOCK_THREAD_CPUTIME_ID";
6162306a36Sopenharmony_ci	case CLOCK_MONOTONIC_RAW:
6262306a36Sopenharmony_ci		return "CLOCK_MONOTONIC_RAW";
6362306a36Sopenharmony_ci	case CLOCK_REALTIME_COARSE:
6462306a36Sopenharmony_ci		return "CLOCK_REALTIME_COARSE";
6562306a36Sopenharmony_ci	case CLOCK_MONOTONIC_COARSE:
6662306a36Sopenharmony_ci		return "CLOCK_MONOTONIC_COARSE";
6762306a36Sopenharmony_ci	case CLOCK_BOOTTIME:
6862306a36Sopenharmony_ci		return "CLOCK_BOOTTIME";
6962306a36Sopenharmony_ci	case CLOCK_REALTIME_ALARM:
7062306a36Sopenharmony_ci		return "CLOCK_REALTIME_ALARM";
7162306a36Sopenharmony_ci	case CLOCK_BOOTTIME_ALARM:
7262306a36Sopenharmony_ci		return "CLOCK_BOOTTIME_ALARM";
7362306a36Sopenharmony_ci	case CLOCK_TAI:
7462306a36Sopenharmony_ci		return "CLOCK_TAI";
7562306a36Sopenharmony_ci	};
7662306a36Sopenharmony_ci	return "UNKNOWN_CLOCKID";
7762306a36Sopenharmony_ci}
7862306a36Sopenharmony_ci
7962306a36Sopenharmony_ci/* returns 1 if a <= b, 0 otherwise */
8062306a36Sopenharmony_cistatic inline int in_order(struct timespec a, struct timespec b)
8162306a36Sopenharmony_ci{
8262306a36Sopenharmony_ci	if (a.tv_sec < b.tv_sec)
8362306a36Sopenharmony_ci		return 1;
8462306a36Sopenharmony_ci	if (a.tv_sec > b.tv_sec)
8562306a36Sopenharmony_ci		return 0;
8662306a36Sopenharmony_ci	if (a.tv_nsec > b.tv_nsec)
8762306a36Sopenharmony_ci		return 0;
8862306a36Sopenharmony_ci	return 1;
8962306a36Sopenharmony_ci}
9062306a36Sopenharmony_ci
9162306a36Sopenharmony_cistruct timespec timespec_add(struct timespec ts, unsigned long long ns)
9262306a36Sopenharmony_ci{
9362306a36Sopenharmony_ci	ts.tv_nsec += ns;
9462306a36Sopenharmony_ci	while (ts.tv_nsec >= NSEC_PER_SEC) {
9562306a36Sopenharmony_ci		ts.tv_nsec -= NSEC_PER_SEC;
9662306a36Sopenharmony_ci		ts.tv_sec++;
9762306a36Sopenharmony_ci	}
9862306a36Sopenharmony_ci	return ts;
9962306a36Sopenharmony_ci}
10062306a36Sopenharmony_ci
10162306a36Sopenharmony_ciint nanosleep_test(int clockid, long long ns)
10262306a36Sopenharmony_ci{
10362306a36Sopenharmony_ci	struct timespec now, target, rel;
10462306a36Sopenharmony_ci
10562306a36Sopenharmony_ci	/* First check abs time */
10662306a36Sopenharmony_ci	if (clock_gettime(clockid, &now))
10762306a36Sopenharmony_ci		return UNSUPPORTED;
10862306a36Sopenharmony_ci	target = timespec_add(now, ns);
10962306a36Sopenharmony_ci
11062306a36Sopenharmony_ci	if (clock_nanosleep(clockid, TIMER_ABSTIME, &target, NULL))
11162306a36Sopenharmony_ci		return UNSUPPORTED;
11262306a36Sopenharmony_ci	clock_gettime(clockid, &now);
11362306a36Sopenharmony_ci
11462306a36Sopenharmony_ci	if (!in_order(target, now))
11562306a36Sopenharmony_ci		return -1;
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_ci	/* Second check reltime */
11862306a36Sopenharmony_ci	clock_gettime(clockid, &now);
11962306a36Sopenharmony_ci	rel.tv_sec = 0;
12062306a36Sopenharmony_ci	rel.tv_nsec = 0;
12162306a36Sopenharmony_ci	rel = timespec_add(rel, ns);
12262306a36Sopenharmony_ci	target = timespec_add(now, ns);
12362306a36Sopenharmony_ci	clock_nanosleep(clockid, 0, &rel, NULL);
12462306a36Sopenharmony_ci	clock_gettime(clockid, &now);
12562306a36Sopenharmony_ci
12662306a36Sopenharmony_ci	if (!in_order(target, now))
12762306a36Sopenharmony_ci		return -1;
12862306a36Sopenharmony_ci	return 0;
12962306a36Sopenharmony_ci}
13062306a36Sopenharmony_ci
13162306a36Sopenharmony_ciint main(int argc, char **argv)
13262306a36Sopenharmony_ci{
13362306a36Sopenharmony_ci	long long length;
13462306a36Sopenharmony_ci	int clockid, ret;
13562306a36Sopenharmony_ci
13662306a36Sopenharmony_ci	ksft_print_header();
13762306a36Sopenharmony_ci	ksft_set_plan(NR_CLOCKIDS);
13862306a36Sopenharmony_ci
13962306a36Sopenharmony_ci	for (clockid = CLOCK_REALTIME; clockid < NR_CLOCKIDS; clockid++) {
14062306a36Sopenharmony_ci
14162306a36Sopenharmony_ci		/* Skip cputime clockids since nanosleep won't increment cputime */
14262306a36Sopenharmony_ci		if (clockid == CLOCK_PROCESS_CPUTIME_ID ||
14362306a36Sopenharmony_ci				clockid == CLOCK_THREAD_CPUTIME_ID ||
14462306a36Sopenharmony_ci				clockid == CLOCK_HWSPECIFIC) {
14562306a36Sopenharmony_ci			ksft_test_result_skip("%-31s\n", clockstring(clockid));
14662306a36Sopenharmony_ci			continue;
14762306a36Sopenharmony_ci		}
14862306a36Sopenharmony_ci
14962306a36Sopenharmony_ci		fflush(stdout);
15062306a36Sopenharmony_ci
15162306a36Sopenharmony_ci		length = 10;
15262306a36Sopenharmony_ci		while (length <= (NSEC_PER_SEC * 10)) {
15362306a36Sopenharmony_ci			ret = nanosleep_test(clockid, length);
15462306a36Sopenharmony_ci			if (ret == UNSUPPORTED) {
15562306a36Sopenharmony_ci				ksft_test_result_skip("%-31s\n", clockstring(clockid));
15662306a36Sopenharmony_ci				goto next;
15762306a36Sopenharmony_ci			}
15862306a36Sopenharmony_ci			if (ret < 0) {
15962306a36Sopenharmony_ci				ksft_test_result_fail("%-31s\n", clockstring(clockid));
16062306a36Sopenharmony_ci				ksft_exit_fail();
16162306a36Sopenharmony_ci			}
16262306a36Sopenharmony_ci			length *= 100;
16362306a36Sopenharmony_ci		}
16462306a36Sopenharmony_ci		ksft_test_result_pass("%-31s\n", clockstring(clockid));
16562306a36Sopenharmony_cinext:
16662306a36Sopenharmony_ci		ret = 0;
16762306a36Sopenharmony_ci	}
16862306a36Sopenharmony_ci	ksft_exit_pass();
16962306a36Sopenharmony_ci}
170