1b7bb8442SJohn Stultz /* alarmtimer suspend test
2b7bb8442SJohn Stultz  *		John Stultz (john.stultz@linaro.org)
3b7bb8442SJohn Stultz  *              (C) Copyright Linaro 2013
4b7bb8442SJohn Stultz  *              Licensed under the GPLv2
5b7bb8442SJohn Stultz  *
6b7bb8442SJohn Stultz  *   This test makes sure the alarmtimer & RTC wakeup code is
7b7bb8442SJohn Stultz  *   functioning.
8b7bb8442SJohn Stultz  *
9b7bb8442SJohn Stultz  *  To build:
10b7bb8442SJohn Stultz  *	$ gcc alarmtimer-suspend.c -o alarmtimer-suspend -lrt
11b7bb8442SJohn Stultz  *
12b7bb8442SJohn Stultz  *   This program is free software: you can redistribute it and/or modify
13b7bb8442SJohn Stultz  *   it under the terms of the GNU General Public License as published by
14b7bb8442SJohn Stultz  *   the Free Software Foundation, either version 2 of the License, or
15b7bb8442SJohn Stultz  *   (at your option) any later version.
16b7bb8442SJohn Stultz  *
17b7bb8442SJohn Stultz  *   This program is distributed in the hope that it will be useful,
18b7bb8442SJohn Stultz  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
19b7bb8442SJohn Stultz  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
20b7bb8442SJohn Stultz  *   GNU General Public License for more details.
21b7bb8442SJohn Stultz  */
22b7bb8442SJohn Stultz 
23b7bb8442SJohn Stultz 
24b7bb8442SJohn Stultz #include <stdio.h>
25b7bb8442SJohn Stultz #include <unistd.h>
26b7bb8442SJohn Stultz #include <time.h>
27b7bb8442SJohn Stultz #include <string.h>
28b7bb8442SJohn Stultz #include <signal.h>
29b7bb8442SJohn Stultz #include <stdlib.h>
30b7bb8442SJohn Stultz #include <pthread.h>
31b7bb8442SJohn Stultz #include "../kselftest.h"
32b7bb8442SJohn Stultz 
33b7bb8442SJohn Stultz #define CLOCK_REALTIME			0
34b7bb8442SJohn Stultz #define CLOCK_MONOTONIC			1
35b7bb8442SJohn Stultz #define CLOCK_PROCESS_CPUTIME_ID	2
36b7bb8442SJohn Stultz #define CLOCK_THREAD_CPUTIME_ID		3
37b7bb8442SJohn Stultz #define CLOCK_MONOTONIC_RAW		4
38b7bb8442SJohn Stultz #define CLOCK_REALTIME_COARSE		5
39b7bb8442SJohn Stultz #define CLOCK_MONOTONIC_COARSE		6
40b7bb8442SJohn Stultz #define CLOCK_BOOTTIME			7
41b7bb8442SJohn Stultz #define CLOCK_REALTIME_ALARM		8
42b7bb8442SJohn Stultz #define CLOCK_BOOTTIME_ALARM		9
43b7bb8442SJohn Stultz #define CLOCK_HWSPECIFIC		10
44b7bb8442SJohn Stultz #define CLOCK_TAI			11
45b7bb8442SJohn Stultz #define NR_CLOCKIDS			12
46b7bb8442SJohn Stultz 
47b7bb8442SJohn Stultz 
48b7bb8442SJohn Stultz #define NSEC_PER_SEC 1000000000ULL
49acd5705dSJohn Stultz #define UNREASONABLE_LAT (NSEC_PER_SEC * 5) /* hopefully we resume in 5 secs */
50b7bb8442SJohn Stultz 
51b7bb8442SJohn Stultz #define SUSPEND_SECS 15
52b7bb8442SJohn Stultz int alarmcount;
53b7bb8442SJohn Stultz int alarm_clock_id;
54b7bb8442SJohn Stultz struct timespec start_time;
55b7bb8442SJohn Stultz 
56b7bb8442SJohn Stultz 
clockstring(int clockid)57b7bb8442SJohn Stultz char *clockstring(int clockid)
58b7bb8442SJohn Stultz {
59b7bb8442SJohn Stultz 	switch (clockid) {
60b7bb8442SJohn Stultz 	case CLOCK_REALTIME:
61b7bb8442SJohn Stultz 		return "CLOCK_REALTIME";
62b7bb8442SJohn Stultz 	case CLOCK_MONOTONIC:
63b7bb8442SJohn Stultz 		return "CLOCK_MONOTONIC";
64b7bb8442SJohn Stultz 	case CLOCK_PROCESS_CPUTIME_ID:
65b7bb8442SJohn Stultz 		return "CLOCK_PROCESS_CPUTIME_ID";
66b7bb8442SJohn Stultz 	case CLOCK_THREAD_CPUTIME_ID:
67b7bb8442SJohn Stultz 		return "CLOCK_THREAD_CPUTIME_ID";
68b7bb8442SJohn Stultz 	case CLOCK_MONOTONIC_RAW:
69b7bb8442SJohn Stultz 		return "CLOCK_MONOTONIC_RAW";
70b7bb8442SJohn Stultz 	case CLOCK_REALTIME_COARSE:
71b7bb8442SJohn Stultz 		return "CLOCK_REALTIME_COARSE";
72b7bb8442SJohn Stultz 	case CLOCK_MONOTONIC_COARSE:
73b7bb8442SJohn Stultz 		return "CLOCK_MONOTONIC_COARSE";
74b7bb8442SJohn Stultz 	case CLOCK_BOOTTIME:
75b7bb8442SJohn Stultz 		return "CLOCK_BOOTTIME";
76b7bb8442SJohn Stultz 	case CLOCK_REALTIME_ALARM:
77b7bb8442SJohn Stultz 		return "CLOCK_REALTIME_ALARM";
78b7bb8442SJohn Stultz 	case CLOCK_BOOTTIME_ALARM:
79b7bb8442SJohn Stultz 		return "CLOCK_BOOTTIME_ALARM";
80b7bb8442SJohn Stultz 	case CLOCK_TAI:
81b7bb8442SJohn Stultz 		return "CLOCK_TAI";
827b0653ecSZhang Mingyu 	}
83b7bb8442SJohn Stultz 	return "UNKNOWN_CLOCKID";
84b7bb8442SJohn Stultz }
85b7bb8442SJohn Stultz 
86b7bb8442SJohn Stultz 
timespec_sub(struct timespec a,struct timespec b)87b7bb8442SJohn Stultz long long timespec_sub(struct timespec a, struct timespec b)
88b7bb8442SJohn Stultz {
89b7bb8442SJohn Stultz 	long long ret = NSEC_PER_SEC * b.tv_sec + b.tv_nsec;
90b7bb8442SJohn Stultz 
91b7bb8442SJohn Stultz 	ret -= NSEC_PER_SEC * a.tv_sec + a.tv_nsec;
92b7bb8442SJohn Stultz 	return ret;
93b7bb8442SJohn Stultz }
94b7bb8442SJohn Stultz 
95*b7ecce68SZan Aziz int final_ret;
96b7bb8442SJohn Stultz 
sigalarm(int signo)97b7bb8442SJohn Stultz void sigalarm(int signo)
98b7bb8442SJohn Stultz {
99b7bb8442SJohn Stultz 	long long delta_ns;
100b7bb8442SJohn Stultz 	struct timespec ts;
101b7bb8442SJohn Stultz 
102b7bb8442SJohn Stultz 	clock_gettime(alarm_clock_id, &ts);
103b7bb8442SJohn Stultz 	alarmcount++;
104b7bb8442SJohn Stultz 
105b7bb8442SJohn Stultz 	delta_ns = timespec_sub(start_time, ts);
106b7bb8442SJohn Stultz 	delta_ns -= NSEC_PER_SEC * SUSPEND_SECS * alarmcount;
107b7bb8442SJohn Stultz 
108b7bb8442SJohn Stultz 	printf("ALARM(%i): %ld:%ld latency: %lld ns ", alarmcount, ts.tv_sec,
109b7bb8442SJohn Stultz 							ts.tv_nsec, delta_ns);
110b7bb8442SJohn Stultz 
111b7bb8442SJohn Stultz 	if (delta_ns > UNREASONABLE_LAT) {
112b7bb8442SJohn Stultz 		printf("[FAIL]\n");
113b7bb8442SJohn Stultz 		final_ret = -1;
114b7bb8442SJohn Stultz 	} else
115b7bb8442SJohn Stultz 		printf("[OK]\n");
116b7bb8442SJohn Stultz 
117b7bb8442SJohn Stultz }
118b7bb8442SJohn Stultz 
main(void)119b7bb8442SJohn Stultz int main(void)
120b7bb8442SJohn Stultz {
121b7bb8442SJohn Stultz 	timer_t tm1;
122b7bb8442SJohn Stultz 	struct itimerspec its1, its2;
123b7bb8442SJohn Stultz 	struct sigevent se;
124b7bb8442SJohn Stultz 	struct sigaction act;
125b7bb8442SJohn Stultz 	int signum = SIGRTMAX;
126b7bb8442SJohn Stultz 
127b7bb8442SJohn Stultz 	/* Set up signal handler: */
128b7bb8442SJohn Stultz 	sigfillset(&act.sa_mask);
129b7bb8442SJohn Stultz 	act.sa_flags = 0;
130b7bb8442SJohn Stultz 	act.sa_handler = sigalarm;
131b7bb8442SJohn Stultz 	sigaction(signum, &act, NULL);
132b7bb8442SJohn Stultz 
133b7bb8442SJohn Stultz 	/* Set up timer: */
134b7bb8442SJohn Stultz 	memset(&se, 0, sizeof(se));
135b7bb8442SJohn Stultz 	se.sigev_notify = SIGEV_SIGNAL;
136b7bb8442SJohn Stultz 	se.sigev_signo = signum;
137b7bb8442SJohn Stultz 	se.sigev_value.sival_int = 0;
138b7bb8442SJohn Stultz 
139b7bb8442SJohn Stultz 	for (alarm_clock_id = CLOCK_REALTIME_ALARM;
140b7bb8442SJohn Stultz 			alarm_clock_id <= CLOCK_BOOTTIME_ALARM;
141b7bb8442SJohn Stultz 			alarm_clock_id++) {
142b7bb8442SJohn Stultz 
143b7bb8442SJohn Stultz 		alarmcount = 0;
14461171d04SJohn Stultz 		if (timer_create(alarm_clock_id, &se, &tm1) == -1) {
145fc4fa6e1SMasanari Iida 			printf("timer_create failed, %s unsupported?\n",
14661171d04SJohn Stultz 					clockstring(alarm_clock_id));
14761171d04SJohn Stultz 			break;
14861171d04SJohn Stultz 		}
149b7bb8442SJohn Stultz 
150b7bb8442SJohn Stultz 		clock_gettime(alarm_clock_id, &start_time);
151b7bb8442SJohn Stultz 		printf("Start time (%s): %ld:%ld\n", clockstring(alarm_clock_id),
152b7bb8442SJohn Stultz 				start_time.tv_sec, start_time.tv_nsec);
153b7bb8442SJohn Stultz 		printf("Setting alarm for every %i seconds\n", SUSPEND_SECS);
154b7bb8442SJohn Stultz 		its1.it_value = start_time;
155b7bb8442SJohn Stultz 		its1.it_value.tv_sec += SUSPEND_SECS;
156b7bb8442SJohn Stultz 		its1.it_interval.tv_sec = SUSPEND_SECS;
157b7bb8442SJohn Stultz 		its1.it_interval.tv_nsec = 0;
158b7bb8442SJohn Stultz 
159b7bb8442SJohn Stultz 		timer_settime(tm1, TIMER_ABSTIME, &its1, &its2);
160b7bb8442SJohn Stultz 
161b7bb8442SJohn Stultz 		while (alarmcount < 5)
162b7bb8442SJohn Stultz 			sleep(1); /* First 5 alarms, do nothing */
163b7bb8442SJohn Stultz 
164b7bb8442SJohn Stultz 		printf("Starting suspend loops\n");
165b7bb8442SJohn Stultz 		while (alarmcount < 10) {
166b7bb8442SJohn Stultz 			int ret;
167b7bb8442SJohn Stultz 
168859b1bebSJohn Stultz 			sleep(3);
169b7bb8442SJohn Stultz 			ret = system("echo mem > /sys/power/state");
170b7bb8442SJohn Stultz 			if (ret)
171b7bb8442SJohn Stultz 				break;
172b7bb8442SJohn Stultz 		}
173b7bb8442SJohn Stultz 		timer_delete(tm1);
174b7bb8442SJohn Stultz 	}
175b7bb8442SJohn Stultz 	if (final_ret)
176b7bb8442SJohn Stultz 		return ksft_exit_fail();
177b7bb8442SJohn Stultz 	return ksft_exit_pass();
178b7bb8442SJohn Stultz }
179