summaryrefstree
path: root/kernel/drivers/misc/tzdev/tz_ree_time.c
blob: 111256ccfe1246c3e931627106dcff7761ecacd1 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
/*
 * Copyright (C) 2012-2017 Samsung Electronics, Inc.
 *
 * This software is licensed under the terms of the GNU General Public
 * License version 2, as published by the Free Software Foundation, and
 * may be copied, distributed, and modified under those terms.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */

#include <linux/kthread.h>
#include <linux/module.h>
#include "tz_iwsock.h"
#include "tz_ree_time.h"

MODULE_AUTHOR("Konstantin Karasev");
MODULE_DESCRIPTION("REE Time service");
MODULE_LICENSE("GPL");

#define ERR(...)		pr_alert("[ree_time] ERR : " __VA_ARGS__)

#define TZ_REE_TIME_SOCK_NAME	"ree_time_socket"

static struct task_struct *ree_time_kthread;

static int tz_ree_time_kthread(void *data)
{
	struct sock_desc *ree_time_listen;
	struct sock_desc *ree_time_conn;
	ssize_t len;
	int req;
	int ret;
	struct timespec ts;
	struct tz_ree_time ree_time;

	(void)data;

	/* Create socket */
	ree_time_listen = tz_iwsock_socket(1);
	if (IS_ERR(ree_time_listen))
		return PTR_ERR(ree_time_listen);

	ret = tz_iwsock_listen(ree_time_listen, TZ_REE_TIME_SOCK_NAME);
	if (ret)
		goto out;

	while (!kthread_should_stop()) {
		/* Accept connection */
		ree_time_conn = tz_iwsock_accept(ree_time_listen);
		if (IS_ERR(ree_time_conn)) {
			ret = PTR_ERR(ree_time_conn);
			goto out;
		}

		/* Process REE time requests from SWd */
		while (!kthread_should_stop()) {
			if ((len = tz_iwsock_read(ree_time_conn, &req,
							sizeof(req), 0))
					!= sizeof(req)) {
				ERR("failed to fetch request, err = %zd\n", len);
				break;
			}

			getnstimeofday(&ts);
			ree_time.sec = ts.tv_sec;
			ree_time.nsec = (unsigned int)ts.tv_nsec;
			if ((len = tz_iwsock_write(ree_time_conn, &ree_time,
							sizeof(ree_time), 0))
					!= sizeof(ree_time)) {
				ERR("failed to send time, err = %zd\n", len);
				break;
			}
		}
		tz_iwsock_release(ree_time_conn);
	}
out:
	tz_iwsock_release(ree_time_listen);

	return ret;
}

static int __init tz_ree_time_init(void)
{
	ree_time_kthread = kthread_run(tz_ree_time_kthread, NULL, "ree_time");
	if (IS_ERR(ree_time_kthread))
		return PTR_ERR(ree_time_kthread);

	return 0;
}

static void __init tz_ree_time_fini(void)
{
	kthread_stop(ree_time_kthread);
}

module_init(tz_ree_time_init);
module_exit(tz_ree_time_fini);