taia.h

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