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
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
|
// SPDX-License-Identifier: GPL-2.0-or-later
/*
* s390 PTP clock driver
*
*/
#include "ptp_private.h"
#include <linux/time.h>
#include <asm/stp.h>
static struct ptp_clock *ptp_stcke_clock, *ptp_qpt_clock;
static int ptp_s390_adjfine(struct ptp_clock_info *ptp, long scaled_ppm)
{
return -EOPNOTSUPP;
}
static int ptp_s390_adjtime(struct ptp_clock_info *ptp, s64 delta)
{
return -EOPNOTSUPP;
}
static struct timespec64 eitod_to_timespec64(union tod_clock *clk)
{
return ns_to_timespec64(eitod_to_ns(clk->eitod - TOD_UNIX_EPOCH));
}
static struct timespec64 tod_to_timespec64(unsigned long tod)
{
return ns_to_timespec64(tod_to_ns(tod - TOD_UNIX_EPOCH));
}
static int ptp_s390_stcke_gettime(struct ptp_clock_info *ptp,
struct timespec64 *ts)
{
union tod_clock tod;
if (!stp_enabled())
return -EOPNOTSUPP;
store_tod_clock_ext(&tod);
*ts = eitod_to_timespec64(&tod);
return 0;
}
static int ptp_s390_qpt_gettime(struct ptp_clock_info *ptp,
struct timespec64 *ts)
{
unsigned long tod;
ptff(&tod, sizeof(tod), PTFF_QPT);
*ts = tod_to_timespec64(tod);
return 0;
}
static int ptp_s390_settime(struct ptp_clock_info *ptp,
const struct timespec64 *ts)
{
return -EOPNOTSUPP;
}
static int s390_arch_ptp_get_crosststamp(ktime_t *device_time,
struct system_counterval_t *system_counter,
void *ctx)
{
union tod_clock clk;
store_tod_clock_ext(&clk);
*device_time = ns_to_ktime(tod_to_ns(clk.tod - TOD_UNIX_EPOCH));
system_counter->cycles = clk.tod;
system_counter->cs_id = CSID_S390_TOD;
return 0;
}
static int ptp_s390_getcrosststamp(struct ptp_clock_info *ptp,
struct system_device_crosststamp *xtstamp)
{
if (!stp_enabled())
return -EOPNOTSUPP;
return get_device_system_crosststamp(s390_arch_ptp_get_crosststamp, NULL, NULL, xtstamp);
}
static struct ptp_clock_info ptp_s390_stcke_info = {
.owner = THIS_MODULE,
.name = "s390 STCKE Clock",
.max_adj = 0,
.adjfine = ptp_s390_adjfine,
.adjtime = ptp_s390_adjtime,
.gettime64 = ptp_s390_stcke_gettime,
.settime64 = ptp_s390_settime,
.getcrosststamp = ptp_s390_getcrosststamp,
};
static struct ptp_clock_info ptp_s390_qpt_info = {
.owner = THIS_MODULE,
.name = "s390 Physical Clock",
.max_adj = 0,
.adjfine = ptp_s390_adjfine,
.adjtime = ptp_s390_adjtime,
.gettime64 = ptp_s390_qpt_gettime,
.settime64 = ptp_s390_settime,
};
static __init int ptp_s390_init(void)
{
ptp_stcke_clock = ptp_clock_register(&ptp_s390_stcke_info, NULL);
if (IS_ERR(ptp_stcke_clock))
return PTR_ERR(ptp_stcke_clock);
ptp_qpt_clock = ptp_clock_register(&ptp_s390_qpt_info, NULL);
if (IS_ERR(ptp_qpt_clock)) {
ptp_clock_unregister(ptp_stcke_clock);
return PTR_ERR(ptp_qpt_clock);
}
return 0;
}
static __exit void ptp_s390_exit(void)
{
ptp_clock_unregister(ptp_qpt_clock);
ptp_clock_unregister(ptp_stcke_clock);
}
module_init(ptp_s390_init);
module_exit(ptp_s390_exit);
MODULE_AUTHOR("Sven Schnelle <svens@linux.ibm.com>");
MODULE_DESCRIPTION("s390 Physical/STCKE Clock PtP Driver");
MODULE_LICENSE("GPL");
|
