taia.h

   1 #ifndef TAIA_H
   2 #define TAIA_H
   3
   4 #include <stdint.h>
   5 #include <stdbool.h>
   6 #include <stdio.h>
   7 #include <sys/time.h>
   8
   9 #include "rnd.h"
  10
  11 struct tai {
  12         uint64_t x;
  13 };
  14
  15 struct taia {
  16         struct tai sec;
  17         uint32_t nano;
  18         uint32_t atto;
  19 };
  20
  21 static inline void tai_pack(unsigned char *s, struct tai *t)
  22 {
  23         uint64_t x;
  24
  25         x = t->x;
  26
  27         s[7] = x & 255; x >>= 8;
  28         s[6] = x & 255; x >>= 8;
  29         s[5] = x & 255; x >>= 8;
  30         s[4] = x & 255; x >>= 8;
  31         s[3] = x & 255; x >>= 8;
  32         s[2] = x & 255; x >>= 8;
  33         s[1] = x & 255; x >>= 8;
  34         s[0] = x;
  35 }
  36
  37 static inline void tai_unpack(unsigned char *s, struct tai *t)
  38 {
  39         uint64_t x;
  40
  41         x = (unsigned char) s[0];
  42         x <<= 8; x += (unsigned char) s[1];
  43         x <<= 8; x += (unsigned char) s[2];
  44         x <<= 8; x += (unsigned char) s[3];
  45         x <<= 8; x += (unsigned char) s[4];
  46         x <<= 8; x += (unsigned char) s[5];
  47         x <<= 8; x += (unsigned char) s[6];
  48         x <<= 8; x += (unsigned char) s[7];
  49
  50         t->x = x;
  51 }
  52
  53 static inline void taia_pack(unsigned char *s, struct taia *t)
  54 {
  55         unsigned long x;
  56
  57         tai_pack(s, &t->sec);
  58
  59         s += 8;
  60
  61         x = t->atto;
  62
  63         s[7] = x & 255; x >>= 8;
  64         s[6] = x & 255; x >>= 8;
  65         s[5] = x & 255; x >>= 8;
  66         s[4] = x;
  67
  68         x = t->nano;
  69
  70         s[3] = x & 255; x >>= 8;
  71         s[2] = x & 255; x >>= 8;
  72         s[1] = x & 255; x >>= 8;
  73         s[0] = x;
  74 }
  75
  76 static inline void taia_unpack(unsigned char *s, struct taia *t)
  77 {
  78         unsigned long x;
  79
  80         tai_unpack(s, &t->sec);
  81
  82         s += 8;
  83
  84         x = (unsigned char) s[4];
  85         x <<= 8; x += (unsigned char) s[5];
  86         x <<= 8; x += (unsigned char) s[6];
  87         x <<= 8; x += (unsigned char) s[7];
  88
  89         t->atto = x;
  90
  91         x = (unsigned char) s[0];
  92         x <<= 8; x += (unsigned char) s[1];
  93         x <<= 8; x += (unsigned char) s[2];
  94         x <<= 8; x += (unsigned char) s[3];
  95
  96         t->nano = x;
  97 }
  98
  99 #define tai_unix(t, u) ((void) ((t)->x = 4611686018427387914ULL + (uint64_t) (u)))
 100
 101 static inline void taia_now(struct taia *t)
 102 {
 103         struct timeval now;
 104
 105         gettimeofday(&now, NULL);
 106
 107         tai_unix(&t->sec, now.tv_sec);
 108         t->nano = 1000 * now.tv_usec + 500;
 109         t->atto = secrand();
 110 }
 111
 112 static inline void taia_sub(struct taia *res, const struct taia *u,
 113                             const struct taia *v)
 114 {
 115         unsigned long unano = u->nano;
 116         unsigned long uatto = u->atto;
 117
 118         res->sec.x = u->sec.x - v->sec.x;
 119         res->nano = unano - v->nano;
 120         res->atto = uatto - v->atto;
 121
 122         if (res->atto > uatto) {
 123                 res->atto += 1000000000UL;
 124                 --res->nano;
 125         }
 126
 127         if (res->nano > unano) {
 128                 res->nano += 1000000000UL;
 129                 --res->sec.x;
 130         }
 131 }
 132
 133 static inline void taia_add(struct taia *res, const struct taia *u,
 134                             const struct taia *v)
 135 {
 136         res->sec.x = u->sec.x + v->sec.x;
 137         res->nano = u->nano + v->nano;
 138         res->atto = u->atto + v->atto;
 139
 140         if (res->atto > 999999999UL) {
 141                 res->atto -= 1000000000UL;
 142                 ++res->nano;
 143         }
 144
 145         if (res->nano > 999999999UL) {
 146                 res->nano -= 1000000000UL;
 147                 ++res->sec.x;
 148         }
 149 }
 150
 151 static inline int taia_less(const struct taia *t, const struct taia *u)
 152 {
 153         if (t->sec.x < u->sec.x)
 154                 return 1;
 155         if (t->sec.x > u->sec.x)
 156                 return 0;
 157         if (t->nano < u->nano)
 158                 return 1;
 159         if (t->nano > u->nano)
 160                 return 0;
 161         return t->atto < u->atto;
 162 }
 163
 164 extern bool taia_looks_good(struct taia *arr_taia, struct taia *pkt_taia);
 165
 166 #endif /* TAIA_H */