1 | // |
2 | // NTPPacket.cpp |
3 | // |
4 | // Library: Net |
5 | // Package: NTP |
6 | // Module: NTPPacket |
7 | // |
8 | // Copyright (c) 2006, Applied Informatics Software Engineering GmbH. |
9 | // and Contributors. |
10 | // |
11 | // SPDX-License-Identifier: BSL-1.0 |
12 | // |
13 | |
14 | |
15 | #include "Poco/Net/NTPPacket.h" |
16 | #include "Poco/Net/NetException.h" |
17 | #include "Poco/Timestamp.h" |
18 | #include "Poco/ByteOrder.h" |
19 | |
20 | |
21 | namespace Poco { |
22 | namespace Net { |
23 | |
24 | |
25 | #if !defined(POCO_COMPILER_SUN) |
26 | #pragma pack(push, 1) |
27 | #else |
28 | #pragma pack(1) |
29 | #endif |
30 | struct NTPPacketData |
31 | { |
32 | Poco::Int8 mode:3; |
33 | Poco::Int8 vn:3; |
34 | Poco::Int8 li:2; |
35 | Poco::Int8 stratum; |
36 | Poco::Int8 pool; |
37 | Poco::Int8 prec; |
38 | Poco::Int32 rootdelay; |
39 | Poco::Int32 rootdisp; |
40 | Poco::Int32 refid; |
41 | Poco::Int64 rts; |
42 | Poco::Int64 ots; |
43 | Poco::Int64 vts; |
44 | Poco::Int64 tts; |
45 | }; |
46 | #if !defined(POCO_COMPILER_SUN) |
47 | #pragma pack(pop) |
48 | #else |
49 | #pragma pack() |
50 | #endif |
51 | |
52 | |
53 | NTPPacket::NTPPacket() : |
54 | // the next 3 fields must be in reverse order from spec |
55 | _leapIndicator(3), |
56 | _version(4), |
57 | _mode(3), |
58 | _stratum(0), |
59 | _pool(6), |
60 | _precision(-18), |
61 | _rootDelay(0), |
62 | _rootDispersion(0), |
63 | _referenceId(0), |
64 | _referenceTimestamp(0), |
65 | _receiveTimestamp(0), |
66 | _transmitTimestamp(0) |
67 | { |
68 | Poco::Timestamp ts; |
69 | _originateTimestamp = ts.utcTime() - 2874597888; |
70 | } |
71 | |
72 | |
73 | NTPPacket::NTPPacket(Poco::UInt8 *packet) |
74 | { |
75 | setPacket(packet); |
76 | } |
77 | |
78 | |
79 | NTPPacket::~NTPPacket() |
80 | { |
81 | } |
82 | |
83 | |
84 | void NTPPacket::packet(Poco::UInt8 *packet) const |
85 | { |
86 | NTPPacketData *p = (NTPPacketData*)packet; |
87 | |
88 | p->li = _leapIndicator; |
89 | p->vn = _version; |
90 | p->mode = _mode; |
91 | p->stratum = _stratum; |
92 | p->pool = _pool; |
93 | p->prec = _precision; |
94 | p->rootdelay = Poco::ByteOrder::toNetwork(_rootDelay); |
95 | p->rootdisp = Poco::ByteOrder::toNetwork(_rootDispersion); |
96 | p->refid = Poco::ByteOrder::toNetwork(_referenceId); |
97 | p->rts = Poco::ByteOrder::toNetwork(_referenceTimestamp); |
98 | p->ots = Poco::ByteOrder::toNetwork(_originateTimestamp); |
99 | p->vts = Poco::ByteOrder::toNetwork(_receiveTimestamp); |
100 | p->tts = Poco::ByteOrder::toNetwork(_transmitTimestamp); |
101 | } |
102 | |
103 | |
104 | void NTPPacket::setPacket(Poco::UInt8 *packet) |
105 | { |
106 | NTPPacketData *p = (NTPPacketData*)packet; |
107 | |
108 | _leapIndicator = p->li; |
109 | _version = p->vn; |
110 | _mode = p->mode; |
111 | _stratum = p->stratum; |
112 | _pool = p->pool; |
113 | _precision = p->prec; |
114 | _rootDelay = Poco::ByteOrder::fromNetwork(p->rootdelay); |
115 | _rootDispersion = Poco::ByteOrder::fromNetwork(p->rootdisp); |
116 | _referenceId = Poco::ByteOrder::fromNetwork(p->refid); |
117 | _referenceTimestamp = Poco::ByteOrder::fromNetwork(p->rts); |
118 | _originateTimestamp = Poco::ByteOrder::fromNetwork(p->ots); |
119 | _receiveTimestamp = Poco::ByteOrder::fromNetwork(p->vts); |
120 | _transmitTimestamp = Poco::ByteOrder::fromNetwork(p->tts); |
121 | } |
122 | |
123 | |
124 | Poco::Timestamp NTPPacket::referenceTime() const |
125 | { |
126 | return convertTime(_referenceTimestamp); |
127 | } |
128 | |
129 | |
130 | Poco::Timestamp NTPPacket::originateTime() const |
131 | { |
132 | return convertTime(_originateTimestamp); |
133 | } |
134 | |
135 | |
136 | Poco::Timestamp NTPPacket::receiveTime() const |
137 | { |
138 | return convertTime(_receiveTimestamp); |
139 | } |
140 | |
141 | |
142 | Poco::Timestamp NTPPacket::transmitTime() const |
143 | { |
144 | return convertTime(_transmitTimestamp); |
145 | } |
146 | |
147 | |
148 | Poco::Timestamp NTPPacket::convertTime(Poco::Int64 tm) const |
149 | { |
150 | const unsigned long seventyYears = 2208988800UL; |
151 | Poco::UInt32 secsSince1900 = UInt32(Poco::ByteOrder::toLittleEndian(tm) >> 32); |
152 | unsigned long epoch = secsSince1900 - seventyYears; |
153 | return Poco::Timestamp::fromEpochTime(epoch); |
154 | } |
155 | |
156 | |
157 | } } // namespace Poco::Net |
158 | |