mirror of https://gerrit.osmocom.org/osmo-tetra
100 lines
2.2 KiB
C
100 lines
2.2 KiB
C
/* 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/18;
|
|
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;
|
|
}
|