Annotation of embedaddon/ntp/include/ntp_fp.h, revision 1.1.1.1
1.1 misho 1: /*
2: * ntp_fp.h - definitions for NTP fixed/floating-point arithmetic
3: */
4:
5: #ifndef NTP_FP_H
6: #define NTP_FP_H
7:
8: #include "ntp_types.h"
9:
10: /*
11: * NTP uses two fixed point formats. The first (l_fp) is the "long"
12: * format and is 64 bits long with the decimal between bits 31 and 32.
13: * This is used for time stamps in the NTP packet header (in network
14: * byte order) and for internal computations of offsets (in local host
15: * byte order). We use the same structure for both signed and unsigned
16: * values, which is a big hack but saves rewriting all the operators
17: * twice. Just to confuse this, we also sometimes just carry the
18: * fractional part in calculations, in both signed and unsigned forms.
19: * Anyway, an l_fp looks like:
20: *
21: * 0 1 2 3
22: * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
23: * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
24: * | Integral Part |
25: * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
26: * | Fractional Part |
27: * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
28: *
29: */
30: typedef struct {
31: union {
32: u_int32 Xl_ui;
33: int32 Xl_i;
34: } Ul_i;
35: union {
36: u_int32 Xl_uf;
37: int32 Xl_f;
38: } Ul_f;
39: } l_fp;
40:
41: #define l_ui Ul_i.Xl_ui /* unsigned integral part */
42: #define l_i Ul_i.Xl_i /* signed integral part */
43: #define l_uf Ul_f.Xl_uf /* unsigned fractional part */
44: #define l_f Ul_f.Xl_f /* signed fractional part */
45:
46: /*
47: * Fractional precision (of an l_fp) is actually the number of
48: * bits in a long.
49: */
50: #define FRACTION_PREC (32)
51:
52:
53: /*
54: * The second fixed point format is 32 bits, with the decimal between
55: * bits 15 and 16. There is a signed version (s_fp) and an unsigned
56: * version (u_fp). This is used to represent synchronizing distance
57: * and synchronizing dispersion in the NTP packet header (again, in
58: * network byte order) and internally to hold both distance and
59: * dispersion values (in local byte order). In network byte order
60: * it looks like:
61: *
62: * 0 1 2 3
63: * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
64: * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
65: * | Integer Part | Fraction Part |
66: * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
67: *
68: */
69: typedef int32 s_fp;
70: typedef u_int32 u_fp;
71:
72: /*
73: * A unit second in fp format. Actually 2**(half_the_bits_in_a_long)
74: */
75: #define FP_SECOND (0x10000)
76:
77: /*
78: * Byte order conversions
79: */
80: #define HTONS_FP(x) (htonl(x))
81: #define HTONL_FP(h, n) do { (n)->l_ui = htonl((h)->l_ui); \
82: (n)->l_uf = htonl((h)->l_uf); } while (0)
83: #define NTOHS_FP(x) (ntohl(x))
84: #define NTOHL_FP(n, h) do { (h)->l_ui = ntohl((n)->l_ui); \
85: (h)->l_uf = ntohl((n)->l_uf); } while (0)
86: #define NTOHL_MFP(ni, nf, hi, hf) \
87: do { (hi) = ntohl(ni); (hf) = ntohl(nf); } while (0)
88: #define HTONL_MFP(hi, hf, ni, nf) \
89: do { (ni) = htonl(hi); (nf) = htonl(hf); } while (0)
90:
91: /* funny ones. Converts ts fractions to net order ts */
92: #define HTONL_UF(uf, nts) \
93: do { (nts)->l_ui = 0; (nts)->l_uf = htonl(uf); } while (0)
94: #define HTONL_F(f, nts) do { (nts)->l_uf = htonl(f); \
95: if ((f) & 0x80000000) \
96: (nts)->l_i = -1; \
97: else \
98: (nts)->l_i = 0; \
99: } while (0)
100:
101: /*
102: * Conversions between the two fixed point types
103: */
104: #define MFPTOFP(x_i, x_f) (((x_i) >= 0x00010000) ? 0x7fffffff : \
105: (((x_i) <= -0x00010000) ? 0x80000000 : \
106: (((x_i)<<16) | (((x_f)>>16)&0xffff))))
107: #define LFPTOFP(v) MFPTOFP((v)->l_i, (v)->l_f)
108:
109: #define UFPTOLFP(x, v) ((v)->l_ui = (u_fp)(x)>>16, (v)->l_uf = (x)<<16)
110: #define FPTOLFP(x, v) (UFPTOLFP((x), (v)), (x) < 0 ? (v)->l_ui -= 0x10000 : 0)
111:
112: #define MAXLFP(v) ((v)->l_ui = 0x7fffffff, (v)->l_uf = 0xffffffff)
113: #define MINLFP(v) ((v)->l_ui = 0x80000000, (v)->l_uf = 0)
114:
115: /*
116: * Primitive operations on long fixed point values. If these are
117: * reminiscent of assembler op codes it's only because some may
118: * be replaced by inline assembler for particular machines someday.
119: * These are the (kind of inefficient) run-anywhere versions.
120: */
121: #define M_NEG(v_i, v_f) /* v = -v */ \
122: do { \
123: if ((v_f) == 0) \
124: (v_i) = -((s_fp)(v_i)); \
125: else { \
126: (v_f) = -((s_fp)(v_f)); \
127: (v_i) = ~(v_i); \
128: } \
129: } while(0)
130:
131: #define M_NEGM(r_i, r_f, a_i, a_f) /* r = -a */ \
132: do { \
133: if ((a_f) == 0) { \
134: (r_f) = 0; \
135: (r_i) = -(a_i); \
136: } else { \
137: (r_f) = -(a_f); \
138: (r_i) = ~(a_i); \
139: } \
140: } while(0)
141:
142: #define M_ADD(r_i, r_f, a_i, a_f) /* r += a */ \
143: do { \
144: register u_int32 lo_tmp; \
145: register u_int32 hi_tmp; \
146: \
147: lo_tmp = ((r_f) & 0xffff) + ((a_f) & 0xffff); \
148: hi_tmp = (((r_f) >> 16) & 0xffff) + (((a_f) >> 16) & 0xffff); \
149: if (lo_tmp & 0x10000) \
150: hi_tmp++; \
151: (r_f) = ((hi_tmp & 0xffff) << 16) | (lo_tmp & 0xffff); \
152: \
153: (r_i) += (a_i); \
154: if (hi_tmp & 0x10000) \
155: (r_i)++; \
156: } while (0)
157:
158: #define M_ADD3(r_ovr, r_i, r_f, a_ovr, a_i, a_f) /* r += a, three word */ \
159: do { \
160: register u_int32 lo_tmp; \
161: register u_int32 hi_tmp; \
162: \
163: lo_tmp = ((r_f) & 0xffff) + ((a_f) & 0xffff); \
164: hi_tmp = (((r_f) >> 16) & 0xffff) + (((a_f) >> 16) & 0xffff); \
165: if (lo_tmp & 0x10000) \
166: hi_tmp++; \
167: (r_f) = ((hi_tmp & 0xffff) << 16) | (lo_tmp & 0xffff); \
168: \
169: lo_tmp = ((r_i) & 0xffff) + ((a_i) & 0xffff); \
170: if (hi_tmp & 0x10000) \
171: lo_tmp++; \
172: hi_tmp = (((r_i) >> 16) & 0xffff) + (((a_i) >> 16) & 0xffff); \
173: if (lo_tmp & 0x10000) \
174: hi_tmp++; \
175: (r_i) = ((hi_tmp & 0xffff) << 16) | (lo_tmp & 0xffff); \
176: \
177: (r_ovr) += (a_ovr); \
178: if (hi_tmp & 0x10000) \
179: (r_ovr)++; \
180: } while (0)
181:
182: #define M_SUB(r_i, r_f, a_i, a_f) /* r -= a */ \
183: do { \
184: register u_int32 lo_tmp; \
185: register u_int32 hi_tmp; \
186: \
187: if ((a_f) == 0) { \
188: (r_i) -= (a_i); \
189: } else { \
190: lo_tmp = ((r_f) & 0xffff) + ((-((s_fp)(a_f))) & 0xffff); \
191: hi_tmp = (((r_f) >> 16) & 0xffff) \
192: + (((-((s_fp)(a_f))) >> 16) & 0xffff); \
193: if (lo_tmp & 0x10000) \
194: hi_tmp++; \
195: (r_f) = ((hi_tmp & 0xffff) << 16) | (lo_tmp & 0xffff); \
196: \
197: (r_i) += ~(a_i); \
198: if (hi_tmp & 0x10000) \
199: (r_i)++; \
200: } \
201: } while (0)
202:
203: #define M_RSHIFTU(v_i, v_f) /* v >>= 1, v is unsigned */ \
204: do { \
205: (v_f) = (u_int32)(v_f) >> 1; \
206: if ((v_i) & 01) \
207: (v_f) |= 0x80000000; \
208: (v_i) = (u_int32)(v_i) >> 1; \
209: } while (0)
210:
211: #define M_RSHIFT(v_i, v_f) /* v >>= 1, v is signed */ \
212: do { \
213: (v_f) = (u_int32)(v_f) >> 1; \
214: if ((v_i) & 01) \
215: (v_f) |= 0x80000000; \
216: if ((v_i) & 0x80000000) \
217: (v_i) = ((v_i) >> 1) | 0x80000000; \
218: else \
219: (v_i) = (v_i) >> 1; \
220: } while (0)
221:
222: #define M_LSHIFT(v_i, v_f) /* v <<= 1 */ \
223: do { \
224: (v_i) <<= 1; \
225: if ((v_f) & 0x80000000) \
226: (v_i) |= 0x1; \
227: (v_f) <<= 1; \
228: } while (0)
229:
230: #define M_LSHIFT3(v_ovr, v_i, v_f) /* v <<= 1, with overflow */ \
231: do { \
232: (v_ovr) <<= 1; \
233: if ((v_i) & 0x80000000) \
234: (v_ovr) |= 0x1; \
235: (v_i) <<= 1; \
236: if ((v_f) & 0x80000000) \
237: (v_i) |= 0x1; \
238: (v_f) <<= 1; \
239: } while (0)
240:
241: #define M_ADDUF(r_i, r_f, uf) /* r += uf, uf is u_int32 fraction */ \
242: M_ADD((r_i), (r_f), 0, (uf)) /* let optimizer worry about it */
243:
244: #define M_SUBUF(r_i, r_f, uf) /* r -= uf, uf is u_int32 fraction */ \
245: M_SUB((r_i), (r_f), 0, (uf)) /* let optimizer worry about it */
246:
247: #define M_ADDF(r_i, r_f, f) /* r += f, f is a int32 fraction */ \
248: do { \
249: if ((f) > 0) \
250: M_ADD((r_i), (r_f), 0, (f)); \
251: else if ((f) < 0) \
252: M_ADD((r_i), (r_f), (-1), (f));\
253: } while(0)
254:
255: #define M_ISNEG(v_i, v_f) /* v < 0 */ \
256: (((v_i) & 0x80000000) != 0)
257:
258: #define M_ISHIS(a_i, a_f, b_i, b_f) /* a >= b unsigned */ \
259: (((u_int32)(a_i)) > ((u_int32)(b_i)) || \
260: ((a_i) == (b_i) && ((u_int32)(a_f)) >= ((u_int32)(b_f))))
261:
262: #define M_ISGEQ(a_i, a_f, b_i, b_f) /* a >= b signed */ \
263: (((int32)(a_i)) > ((int32)(b_i)) || \
264: ((a_i) == (b_i) && ((u_int32)(a_f)) >= ((u_int32)(b_f))))
265:
266: #define M_ISEQU(a_i, a_f, b_i, b_f) /* a == b unsigned */ \
267: ((a_i) == (b_i) && (a_f) == (b_f))
268:
269: /*
270: * Operations on the long fp format
271: */
272: #define L_ADD(r, a) M_ADD((r)->l_ui, (r)->l_uf, (a)->l_ui, (a)->l_uf)
273: #define L_SUB(r, a) M_SUB((r)->l_ui, (r)->l_uf, (a)->l_ui, (a)->l_uf)
274: #define L_NEG(v) M_NEG((v)->l_ui, (v)->l_uf)
275: #define L_ADDUF(r, uf) M_ADDUF((r)->l_ui, (r)->l_uf, (uf))
276: #define L_SUBUF(r, uf) M_SUBUF((r)->l_ui, (r)->l_uf, (uf))
277: #define L_ADDF(r, f) M_ADDF((r)->l_ui, (r)->l_uf, (f))
278: #define L_RSHIFT(v) M_RSHIFT((v)->l_i, (v)->l_uf)
279: #define L_RSHIFTU(v) M_RSHIFTU((v)->l_ui, (v)->l_uf)
280: #define L_LSHIFT(v) M_LSHIFT((v)->l_ui, (v)->l_uf)
281: #define L_CLR(v) ((v)->l_ui = (v)->l_uf = 0)
282:
283: #define L_ISNEG(v) (((v)->l_ui & 0x80000000) != 0)
284: #define L_ISZERO(v) ((v)->l_ui == 0 && (v)->l_uf == 0)
285: #define L_ISHIS(a, b) ((a)->l_ui > (b)->l_ui || \
286: ((a)->l_ui == (b)->l_ui && (a)->l_uf >= (b)->l_uf))
287: #define L_ISGEQ(a, b) ((a)->l_i > (b)->l_i || \
288: ((a)->l_i == (b)->l_i && (a)->l_uf >= (b)->l_uf))
289: #define L_ISEQU(a, b) M_ISEQU((a)->l_ui, (a)->l_uf, (b)->l_ui, (b)->l_uf)
290:
291: /*
292: * s_fp/double and u_fp/double conversions
293: */
294: #define FRIC 65536. /* 2^16 as a double */
295: #define DTOFP(r) ((s_fp)((r) * FRIC))
296: #define DTOUFP(r) ((u_fp)((r) * FRIC))
297: #define FPTOD(r) ((double)(r) / FRIC)
298:
299: /*
300: * l_fp/double conversions
301: */
302: #define FRAC 4294967296. /* 2^32 as a double */
303: #define M_DTOLFP(d, r_i, r_uf) /* double to l_fp */ \
304: do { \
305: register double d_tmp; \
306: \
307: d_tmp = (d); \
308: if (d_tmp < 0) { \
309: d_tmp = -d_tmp; \
310: (r_i) = (int32)(d_tmp); \
311: (r_uf) = (u_int32)(((d_tmp) - (double)(r_i)) * FRAC); \
312: M_NEG((r_i), (r_uf)); \
313: } else { \
314: (r_i) = (int32)(d_tmp); \
315: (r_uf) = (u_int32)(((d_tmp) - (double)(r_i)) * FRAC); \
316: } \
317: } while (0)
318: #define M_LFPTOD(r_i, r_uf, d) /* l_fp to double */ \
319: do { \
320: register l_fp l_tmp; \
321: \
322: l_tmp.l_i = (r_i); \
323: l_tmp.l_f = (r_uf); \
324: if (l_tmp.l_i < 0) { \
325: M_NEG(l_tmp.l_i, l_tmp.l_uf); \
326: (d) = -((double)l_tmp.l_i + ((double)l_tmp.l_uf) / FRAC); \
327: } else { \
328: (d) = (double)l_tmp.l_i + ((double)l_tmp.l_uf) / FRAC; \
329: } \
330: } while (0)
331: #define DTOLFP(d, v) M_DTOLFP((d), (v)->l_ui, (v)->l_uf)
332: #define LFPTOD(v, d) M_LFPTOD((v)->l_ui, (v)->l_uf, (d))
333:
334: /*
335: * Prototypes
336: */
337: extern char * dofptoa (u_fp, int, short, int);
338: extern char * dolfptoa (u_long, u_long, int, short, int);
339:
340: extern int atolfp (const char *, l_fp *);
341: extern int buftvtots (const char *, l_fp *);
342: extern char * fptoa (s_fp, short);
343: extern char * fptoms (s_fp, short);
344: extern int hextolfp (const char *, l_fp *);
345: extern void gpstolfp (int, int, unsigned long, l_fp *);
346: extern int mstolfp (const char *, l_fp *);
347: extern char * prettydate (l_fp *);
348: extern char * gmprettydate (l_fp *);
349: extern char * uglydate (l_fp *);
350: extern void mfp_mul (int32 *, u_int32 *, int32, u_int32, int32, u_int32);
351:
352: extern void get_systime (l_fp *);
353: extern int step_systime (double);
354: extern int adj_systime (double);
355:
356: extern struct tm * ntp2unix_tm (u_long ntp, int local);
357:
358: #define lfptoa(fpv, ndec) mfptoa((fpv)->l_ui, (fpv)->l_uf, (ndec))
359: #define lfptoms(fpv, ndec) mfptoms((fpv)->l_ui, (fpv)->l_uf, (ndec))
360:
361: #define stoa(addr) socktoa(addr)
362: #define ntoa(addr) stoa(addr)
363: #define stohost(addr) socktohost(addr)
364:
365: #define ufptoa(fpv, ndec) dofptoa((fpv), 0, (ndec), 0)
366: #define ufptoms(fpv, ndec) dofptoa((fpv), 0, (ndec), 1)
367: #define ulfptoa(fpv, ndec) dolfptoa((fpv)->l_ui, (fpv)->l_uf, 0, (ndec), 0)
368: #define ulfptoms(fpv, ndec) dolfptoa((fpv)->l_ui, (fpv)->l_uf, 0, (ndec), 1)
369: #define umfptoa(fpi, fpf, ndec) dolfptoa((fpi), (fpf), 0, (ndec), 0)
370:
371: #endif /* NTP_FP_H */
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/icons/cvsweb/back.gif){kind=icon}
Return to ntp_fp.h CVS log ![[TXT]](/icons/cvsweb/text.gif){kind=icon}
![[DIR]](/icons/cvsweb/dir.gif){kind=icon}
Up to [ELWIX - Embedded LightWeight unIX -] / embedaddon / ntp / include