162306a36Sopenharmony_ci/* alarmtimer suspend test 262306a36Sopenharmony_ci * John Stultz (john.stultz@linaro.org) 362306a36Sopenharmony_ci * (C) Copyright Linaro 2013 462306a36Sopenharmony_ci * Licensed under the GPLv2 562306a36Sopenharmony_ci * 662306a36Sopenharmony_ci * This test makes sure the alarmtimer & RTC wakeup code is 762306a36Sopenharmony_ci * functioning. 862306a36Sopenharmony_ci * 962306a36Sopenharmony_ci * To build: 1062306a36Sopenharmony_ci * $ gcc alarmtimer-suspend.c -o alarmtimer-suspend -lrt 1162306a36Sopenharmony_ci * 1262306a36Sopenharmony_ci * This program is free software: you can redistribute it and/or modify 1362306a36Sopenharmony_ci * it under the terms of the GNU General Public License as published by 1462306a36Sopenharmony_ci * the Free Software Foundation, either version 2 of the License, or 1562306a36Sopenharmony_ci * (at your option) any later version. 1662306a36Sopenharmony_ci * 1762306a36Sopenharmony_ci * This program is distributed in the hope that it will be useful, 1862306a36Sopenharmony_ci * but WITHOUT ANY WARRANTY; without even the implied warranty of 1962306a36Sopenharmony_ci * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 2062306a36Sopenharmony_ci * GNU General Public License for more details. 2162306a36Sopenharmony_ci */ 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_ci 2462306a36Sopenharmony_ci#include <stdio.h> 2562306a36Sopenharmony_ci#include <unistd.h> 2662306a36Sopenharmony_ci#include <time.h> 2762306a36Sopenharmony_ci#include <string.h> 2862306a36Sopenharmony_ci#include <signal.h> 2962306a36Sopenharmony_ci#include <stdlib.h> 3062306a36Sopenharmony_ci#include <pthread.h> 3162306a36Sopenharmony_ci#include "../kselftest.h" 3262306a36Sopenharmony_ci 3362306a36Sopenharmony_ci#define CLOCK_REALTIME 0 3462306a36Sopenharmony_ci#define CLOCK_MONOTONIC 1 3562306a36Sopenharmony_ci#define CLOCK_PROCESS_CPUTIME_ID 2 3662306a36Sopenharmony_ci#define CLOCK_THREAD_CPUTIME_ID 3 3762306a36Sopenharmony_ci#define CLOCK_MONOTONIC_RAW 4 3862306a36Sopenharmony_ci#define CLOCK_REALTIME_COARSE 5 3962306a36Sopenharmony_ci#define CLOCK_MONOTONIC_COARSE 6 4062306a36Sopenharmony_ci#define CLOCK_BOOTTIME 7 4162306a36Sopenharmony_ci#define CLOCK_REALTIME_ALARM 8 4262306a36Sopenharmony_ci#define CLOCK_BOOTTIME_ALARM 9 4362306a36Sopenharmony_ci#define CLOCK_HWSPECIFIC 10 4462306a36Sopenharmony_ci#define CLOCK_TAI 11 4562306a36Sopenharmony_ci#define NR_CLOCKIDS 12 4662306a36Sopenharmony_ci 4762306a36Sopenharmony_ci 4862306a36Sopenharmony_ci#define NSEC_PER_SEC 1000000000ULL 4962306a36Sopenharmony_ci#define UNREASONABLE_LAT (NSEC_PER_SEC * 5) /* hopefully we resume in 5 secs */ 5062306a36Sopenharmony_ci 5162306a36Sopenharmony_ci#define SUSPEND_SECS 15 5262306a36Sopenharmony_ciint alarmcount; 5362306a36Sopenharmony_ciint alarm_clock_id; 5462306a36Sopenharmony_cistruct timespec start_time; 5562306a36Sopenharmony_ci 5662306a36Sopenharmony_ci 5762306a36Sopenharmony_cichar *clockstring(int clockid) 5862306a36Sopenharmony_ci{ 5962306a36Sopenharmony_ci switch (clockid) { 6062306a36Sopenharmony_ci case CLOCK_REALTIME: 6162306a36Sopenharmony_ci return "CLOCK_REALTIME"; 6262306a36Sopenharmony_ci case CLOCK_MONOTONIC: 6362306a36Sopenharmony_ci return "CLOCK_MONOTONIC"; 6462306a36Sopenharmony_ci case CLOCK_PROCESS_CPUTIME_ID: 6562306a36Sopenharmony_ci return "CLOCK_PROCESS_CPUTIME_ID"; 6662306a36Sopenharmony_ci case CLOCK_THREAD_CPUTIME_ID: 6762306a36Sopenharmony_ci return "CLOCK_THREAD_CPUTIME_ID"; 6862306a36Sopenharmony_ci case CLOCK_MONOTONIC_RAW: 6962306a36Sopenharmony_ci return "CLOCK_MONOTONIC_RAW"; 7062306a36Sopenharmony_ci case CLOCK_REALTIME_COARSE: 7162306a36Sopenharmony_ci return "CLOCK_REALTIME_COARSE"; 7262306a36Sopenharmony_ci case CLOCK_MONOTONIC_COARSE: 7362306a36Sopenharmony_ci return "CLOCK_MONOTONIC_COARSE"; 7462306a36Sopenharmony_ci case CLOCK_BOOTTIME: 7562306a36Sopenharmony_ci return "CLOCK_BOOTTIME"; 7662306a36Sopenharmony_ci case CLOCK_REALTIME_ALARM: 7762306a36Sopenharmony_ci return "CLOCK_REALTIME_ALARM"; 7862306a36Sopenharmony_ci case CLOCK_BOOTTIME_ALARM: 7962306a36Sopenharmony_ci return "CLOCK_BOOTTIME_ALARM"; 8062306a36Sopenharmony_ci case CLOCK_TAI: 8162306a36Sopenharmony_ci return "CLOCK_TAI"; 8262306a36Sopenharmony_ci } 8362306a36Sopenharmony_ci return "UNKNOWN_CLOCKID"; 8462306a36Sopenharmony_ci} 8562306a36Sopenharmony_ci 8662306a36Sopenharmony_ci 8762306a36Sopenharmony_cilong long timespec_sub(struct timespec a, struct timespec b) 8862306a36Sopenharmony_ci{ 8962306a36Sopenharmony_ci long long ret = NSEC_PER_SEC * b.tv_sec + b.tv_nsec; 9062306a36Sopenharmony_ci 9162306a36Sopenharmony_ci ret -= NSEC_PER_SEC * a.tv_sec + a.tv_nsec; 9262306a36Sopenharmony_ci return ret; 9362306a36Sopenharmony_ci} 9462306a36Sopenharmony_ci 9562306a36Sopenharmony_ciint final_ret; 9662306a36Sopenharmony_ci 9762306a36Sopenharmony_civoid sigalarm(int signo) 9862306a36Sopenharmony_ci{ 9962306a36Sopenharmony_ci long long delta_ns; 10062306a36Sopenharmony_ci struct timespec ts; 10162306a36Sopenharmony_ci 10262306a36Sopenharmony_ci clock_gettime(alarm_clock_id, &ts); 10362306a36Sopenharmony_ci alarmcount++; 10462306a36Sopenharmony_ci 10562306a36Sopenharmony_ci delta_ns = timespec_sub(start_time, ts); 10662306a36Sopenharmony_ci delta_ns -= NSEC_PER_SEC * SUSPEND_SECS * alarmcount; 10762306a36Sopenharmony_ci 10862306a36Sopenharmony_ci printf("ALARM(%i): %ld:%ld latency: %lld ns ", alarmcount, ts.tv_sec, 10962306a36Sopenharmony_ci ts.tv_nsec, delta_ns); 11062306a36Sopenharmony_ci 11162306a36Sopenharmony_ci if (delta_ns > UNREASONABLE_LAT) { 11262306a36Sopenharmony_ci printf("[FAIL]\n"); 11362306a36Sopenharmony_ci final_ret = -1; 11462306a36Sopenharmony_ci } else 11562306a36Sopenharmony_ci printf("[OK]\n"); 11662306a36Sopenharmony_ci 11762306a36Sopenharmony_ci} 11862306a36Sopenharmony_ci 11962306a36Sopenharmony_ciint main(void) 12062306a36Sopenharmony_ci{ 12162306a36Sopenharmony_ci timer_t tm1; 12262306a36Sopenharmony_ci struct itimerspec its1, its2; 12362306a36Sopenharmony_ci struct sigevent se; 12462306a36Sopenharmony_ci struct sigaction act; 12562306a36Sopenharmony_ci int signum = SIGRTMAX; 12662306a36Sopenharmony_ci 12762306a36Sopenharmony_ci /* Set up signal handler: */ 12862306a36Sopenharmony_ci sigfillset(&act.sa_mask); 12962306a36Sopenharmony_ci act.sa_flags = 0; 13062306a36Sopenharmony_ci act.sa_handler = sigalarm; 13162306a36Sopenharmony_ci sigaction(signum, &act, NULL); 13262306a36Sopenharmony_ci 13362306a36Sopenharmony_ci /* Set up timer: */ 13462306a36Sopenharmony_ci memset(&se, 0, sizeof(se)); 13562306a36Sopenharmony_ci se.sigev_notify = SIGEV_SIGNAL; 13662306a36Sopenharmony_ci se.sigev_signo = signum; 13762306a36Sopenharmony_ci se.sigev_value.sival_int = 0; 13862306a36Sopenharmony_ci 13962306a36Sopenharmony_ci for (alarm_clock_id = CLOCK_REALTIME_ALARM; 14062306a36Sopenharmony_ci alarm_clock_id <= CLOCK_BOOTTIME_ALARM; 14162306a36Sopenharmony_ci alarm_clock_id++) { 14262306a36Sopenharmony_ci 14362306a36Sopenharmony_ci alarmcount = 0; 14462306a36Sopenharmony_ci if (timer_create(alarm_clock_id, &se, &tm1) == -1) { 14562306a36Sopenharmony_ci printf("timer_create failed, %s unsupported?\n", 14662306a36Sopenharmony_ci clockstring(alarm_clock_id)); 14762306a36Sopenharmony_ci break; 14862306a36Sopenharmony_ci } 14962306a36Sopenharmony_ci 15062306a36Sopenharmony_ci clock_gettime(alarm_clock_id, &start_time); 15162306a36Sopenharmony_ci printf("Start time (%s): %ld:%ld\n", clockstring(alarm_clock_id), 15262306a36Sopenharmony_ci start_time.tv_sec, start_time.tv_nsec); 15362306a36Sopenharmony_ci printf("Setting alarm for every %i seconds\n", SUSPEND_SECS); 15462306a36Sopenharmony_ci its1.it_value = start_time; 15562306a36Sopenharmony_ci its1.it_value.tv_sec += SUSPEND_SECS; 15662306a36Sopenharmony_ci its1.it_interval.tv_sec = SUSPEND_SECS; 15762306a36Sopenharmony_ci its1.it_interval.tv_nsec = 0; 15862306a36Sopenharmony_ci 15962306a36Sopenharmony_ci timer_settime(tm1, TIMER_ABSTIME, &its1, &its2); 16062306a36Sopenharmony_ci 16162306a36Sopenharmony_ci while (alarmcount < 5) 16262306a36Sopenharmony_ci sleep(1); /* First 5 alarms, do nothing */ 16362306a36Sopenharmony_ci 16462306a36Sopenharmony_ci printf("Starting suspend loops\n"); 16562306a36Sopenharmony_ci while (alarmcount < 10) { 16662306a36Sopenharmony_ci int ret; 16762306a36Sopenharmony_ci 16862306a36Sopenharmony_ci sleep(3); 16962306a36Sopenharmony_ci ret = system("echo mem > /sys/power/state"); 17062306a36Sopenharmony_ci if (ret) 17162306a36Sopenharmony_ci break; 17262306a36Sopenharmony_ci } 17362306a36Sopenharmony_ci timer_delete(tm1); 17462306a36Sopenharmony_ci } 17562306a36Sopenharmony_ci if (final_ret) 17662306a36Sopenharmony_ci return ksft_exit_fail(); 17762306a36Sopenharmony_ci return ksft_exit_pass(); 17862306a36Sopenharmony_ci} 179