Blame view

RIOT/sys/timex/timex_to_str.c 1.51 KB
fb11e647   vrobic   reseau statique a...
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
  /*
   * Copyright (C) 2015 Martine Lenders <mlenders@inf.fu-berlin.de>
   *
   * This file is subject to the terms and conditions of the GNU Lesser
   * General Public License v2.1. See the file LICENSE in the top level
   * directory for more details.
   */
  
  /**
   * @{
   *
   * @file
   */
  
  #include <stdint.h>
  
  #include "timex.h"
  
  #define RADIX   (10)
  
  static unsigned int u32_to_str(char *str, uint32_t u32)
  {
      int len;
      int i = 0;
      if (u32 == 0) {
          str[i] = '0';
          return 1;
      }
      for (; u32 > 0; u32 /= RADIX) {
          char digit = (char)(u32 % RADIX);
          str[i++] = '0' + digit;
      }
      len = i;
      i--;    /* go back to last character */
      for (int j = 0; j < i; j++, i--) {
          char tmp = str[i];
          str[i] = str[j];
          str[j] = tmp;
      }
      return len;
  }
  
  const char *timex_to_str(timex_t t, char *timestamp)
  {
      timex_normalize(&t);
      char *dec;
      uint8_t offset = 6;
      /* get seconds and set terminating '\0' byte */
      dec = &timestamp[u32_to_str(timestamp, t.seconds)];
      *(dec++) = '.';                         /* set decimal point */
      for (uint32_t i = 100000; i > 1; i /= 10) {  /* timex_normalize() ensures that i < 1000000 */
          if (t.microseconds < i) {           /* pad with 0's */
              *(dec++) = '0';
              offset--;
          }
      }
      u32_to_str(dec, t.microseconds);        /* convert microseconds */
      dec += offset;
      *(dec++) = ' ';                         /* append unit */
      *(dec++) = 's';
      *(dec) = '\0';
      return timestamp;
  }
  
  /** @} */