add xenomai

hc

2024-11-01 2f529f9b558ca1c1bd74be7437a84e4711743404

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
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
/*
 * Copyright (C) 2013 Philippe Gerum <rpm@xenomai.org>.
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2 of the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA.
 */
#include "boilerplate/time.h"
 
void timespec_sub(struct timespec *__restrict r,
          const struct timespec *__restrict t1,
          const struct timespec *__restrict t2)
{
    r->tv_sec = t1->tv_sec - t2->tv_sec;
    r->tv_nsec = t1->tv_nsec - t2->tv_nsec;
    if (r->tv_nsec < 0) {
        r->tv_sec--;
        r->tv_nsec += 1000000000;
    }
}
 
void timespec_subs(struct timespec *__restrict r,
           const struct timespec *__restrict t1,
           sticks_t t2)
{
    sticks_t s, rem;
 
    s = t2 / 1000000000;
    rem = t2 - s * 1000000000;
    r->tv_sec = t1->tv_sec - s;
    r->tv_nsec = t1->tv_nsec - rem;
    if (r->tv_nsec < 0) {
        r->tv_sec--;
        r->tv_nsec += 1000000000;
    }
}
 
void timespec_add(struct timespec *__restrict r,
          const struct timespec *__restrict t1,
          const struct timespec *__restrict t2)
{
    r->tv_sec = t1->tv_sec + t2->tv_sec;
    r->tv_nsec = t1->tv_nsec + t2->tv_nsec;
    if (r->tv_nsec >= 1000000000) {
        r->tv_sec++;
        r->tv_nsec -= 1000000000;
    }
}
 
void timespec_adds(struct timespec *__restrict r,
           const struct timespec *__restrict t1,
           sticks_t t2)
{
    sticks_t s, rem;
 
    s = t2 / 1000000000;
    rem = t2 - s * 1000000000;
    r->tv_sec = t1->tv_sec + s;
    r->tv_nsec = t1->tv_nsec + rem;
    if (r->tv_nsec >= 1000000000) {
        r->tv_sec++;
        r->tv_nsec -= 1000000000;
    }
}
 
void timespec_sets(struct timespec *__restrict r,
           ticks_t ns)
{
    r->tv_sec = ns / 1000000000UL;
    r->tv_nsec = ns - r->tv_sec * 1000000000UL;
    if (r->tv_nsec >= 1000000000) {
        r->tv_sec++;
        r->tv_nsec -= 1000000000;
    }
}