162306a36Sopenharmony_ci/* Set tai offset
262306a36Sopenharmony_ci *              by: John Stultz <john.stultz@linaro.org>
362306a36Sopenharmony_ci *              (C) Copyright Linaro 2013
462306a36Sopenharmony_ci *              Licensed under the GPLv2
562306a36Sopenharmony_ci *
662306a36Sopenharmony_ci *   This program is free software: you can redistribute it and/or modify
762306a36Sopenharmony_ci *   it under the terms of the GNU General Public License as published by
862306a36Sopenharmony_ci *   the Free Software Foundation, either version 2 of the License, or
962306a36Sopenharmony_ci *   (at your option) any later version.
1062306a36Sopenharmony_ci *
1162306a36Sopenharmony_ci *   This program is distributed in the hope that it will be useful,
1262306a36Sopenharmony_ci *   but WITHOUT ANY WARRANTY; without even the implied warranty of
1362306a36Sopenharmony_ci *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
1462306a36Sopenharmony_ci *   GNU General Public License for more details.
1562306a36Sopenharmony_ci */
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci
1862306a36Sopenharmony_ci#include <stdio.h>
1962306a36Sopenharmony_ci#include <stdlib.h>
2062306a36Sopenharmony_ci#include <time.h>
2162306a36Sopenharmony_ci#include <sys/time.h>
2262306a36Sopenharmony_ci#include <sys/timex.h>
2362306a36Sopenharmony_ci#include <string.h>
2462306a36Sopenharmony_ci#include <signal.h>
2562306a36Sopenharmony_ci#include <unistd.h>
2662306a36Sopenharmony_ci#include "../kselftest.h"
2762306a36Sopenharmony_ci
2862306a36Sopenharmony_ciint set_tai(int offset)
2962306a36Sopenharmony_ci{
3062306a36Sopenharmony_ci	struct timex tx;
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_ci	memset(&tx, 0, sizeof(tx));
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_ci	tx.modes = ADJ_TAI;
3562306a36Sopenharmony_ci	tx.constant = offset;
3662306a36Sopenharmony_ci
3762306a36Sopenharmony_ci	return adjtimex(&tx);
3862306a36Sopenharmony_ci}
3962306a36Sopenharmony_ci
4062306a36Sopenharmony_ciint get_tai(void)
4162306a36Sopenharmony_ci{
4262306a36Sopenharmony_ci	struct timex tx;
4362306a36Sopenharmony_ci
4462306a36Sopenharmony_ci	memset(&tx, 0, sizeof(tx));
4562306a36Sopenharmony_ci
4662306a36Sopenharmony_ci	adjtimex(&tx);
4762306a36Sopenharmony_ci	return tx.tai;
4862306a36Sopenharmony_ci}
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_ciint main(int argc, char **argv)
5162306a36Sopenharmony_ci{
5262306a36Sopenharmony_ci	int i, ret;
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_ci	ret = get_tai();
5562306a36Sopenharmony_ci	printf("tai offset started at %i\n", ret);
5662306a36Sopenharmony_ci
5762306a36Sopenharmony_ci	printf("Checking tai offsets can be properly set: ");
5862306a36Sopenharmony_ci	fflush(stdout);
5962306a36Sopenharmony_ci	for (i = 1; i <= 60; i++) {
6062306a36Sopenharmony_ci		ret = set_tai(i);
6162306a36Sopenharmony_ci		ret = get_tai();
6262306a36Sopenharmony_ci		if (ret != i) {
6362306a36Sopenharmony_ci			printf("[FAILED] expected: %i got %i\n", i, ret);
6462306a36Sopenharmony_ci			return ksft_exit_fail();
6562306a36Sopenharmony_ci		}
6662306a36Sopenharmony_ci	}
6762306a36Sopenharmony_ci	printf("[OK]\n");
6862306a36Sopenharmony_ci	return ksft_exit_pass();
6962306a36Sopenharmony_ci}
70