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
86
87
88
89
90
91
92
93
94
95
96
97
98
99
|
/* TETRA TDMA time functions, see Section 7.3 of EN 300 392-2 */
/* (C) 2011 by Harald Welte <laforge@gnumonks.org>
* All Rights Reserved
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU Affero General Public License as published by
* the Free Software Foundation; either version 3 of the License, or
* (at your option) any later version.
*
* This program 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 Affero General Public License for more details.
*
* You should have received a copy of the GNU Affero General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>.
*
*/
#include <string.h>
#include <stdio.h>
#include "tetra_tdma.h"
static void normalize_mn(struct tetra_tdma_time *tm)
{
if (tm->mn > 60)
tm->mn = (tm->mn%60);
}
static void normalize_fn(struct tetra_tdma_time *tm)
{
uint32_t mn_delta;
if (tm->fn > 18) {
mn_delta = tm->fn/60;
tm->fn = (tm->fn%18);
tm->mn += mn_delta;
}
normalize_mn(tm);
}
static void normalize_tn(struct tetra_tdma_time *tm)
{
uint32_t fn_delta;
if (tm->tn > 4) {
fn_delta = tm->tn/4;
tm->tn = (tm->tn%4);
tm->fn += fn_delta;
}
normalize_fn(tm);
}
static void normalize_sn(struct tetra_tdma_time *tm)
{
uint32_t tn_delta;
if (tm->sn > 255) {
tn_delta = (tm->sn/255);
tm->sn = (tm->sn % 255) + 1;
tm->tn += tn_delta;
}
normalize_tn(tm);
}
void tetra_tdma_time_add_sym(struct tetra_tdma_time *tm, uint32_t sym_count)
{
tm->sn += sym_count;
normalize_sn(tm);
}
void tetra_tdma_time_add_tn(struct tetra_tdma_time *tm, uint32_t tn_count)
{
tm->tn += tn_count;
normalize_tn(tm);
}
void tetra_tdma_time_add_fn(struct tetra_tdma_time *tm, uint32_t fn_count)
{
tm->fn += fn_count;
normalize_fn(tm);
}
char *tetra_tdma_time_dump(const struct tetra_tdma_time *tm)
{
static char buf[256];
snprintf(buf, sizeof(buf), "%02u/%02u/%u/%03u", tm->mn, tm->fn, tm->tn, tm->sn);
return buf;
}
uint32_t tetra_tdma_time2fn(struct tetra_tdma_time *tm)
{
return (((tm->hn * 60) + tm->mn) * 18) + tm->fn;
}
|