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
|
// P25 TDMA Decoder (C) Copyright 2013, 2014 Max H. Parke KA1RBI
//
// This file is part of OP25
//
// OP25 is free software; you can redistribute it and/or modify it
// under the terms of the GNU General Public License as published by
// the Free Software Foundation; either version 3, or (at your option)
// any later version.
//
// OP25 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 General Public
// License for more details.
//
// You should have received a copy of the GNU General Public License
// along with OP25; see the file COPYING. If not, write to the Free
// Software Foundation, Inc., 51 Franklin Street, Boston, MA
// 02110-1301, USA.
#include <stdint.h>
#include <vector>
#include <iostream>
#include "p25p2_duid.h"
static const int16_t _duid_lookup[256] = {
0,0,0,-1,0,-1,-1,1,0,-1,-1,4,-1,8,2,-1,
0,-1,-1,1,-1,1,1,1,-1,3,9,-1,5,-1,-1,1,
0,-1,-1,10,-1,6,2,-1,-1,3,2,-1,2,-1,2,2,
-1,3,7,-1,11,-1,-1,1,3,3,-1,3,-1,3,2,-1,
0,-1,-1,4,-1,6,12,-1,-1,4,4,4,5,-1,-1,4,
-1,13,7,-1,5,-1,-1,1,5,-1,-1,4,5,5,5,-1,
-1,6,7,-1,6,6,-1,6,14,-1,-1,4,-1,6,2,-1,
7,-1,7,7,-1,6,7,-1,-1,3,7,-1,5,-1,-1,15,
0,-1,-1,10,-1,8,12,-1,-1,8,9,-1,8,8,-1,8,
-1,13,9,-1,11,-1,-1,1,9,-1,9,9,-1,8,9,-1,
-1,10,10,10,11,-1,-1,10,14,-1,-1,10,-1,8,2,-1,
11,-1,-1,10,11,11,11,-1,-1,3,9,-1,11,-1,-1,15,
-1,13,12,-1,12,-1,12,12,14,-1,-1,4,-1,8,12,-1,
13,13,-1,13,-1,13,12,-1,-1,13,9,-1,5,-1,-1,15,
14,-1,-1,10,-1,6,12,-1,14,14,14,-1,14,-1,-1,15,
-1,13,7,-1,11,-1,-1,15,14,-1,-1,15,-1,15,15,15,
};
p25p2_duid::p25p2_duid(void)
{
}
int16_t p25p2_duid::duid_lookup(const uint8_t codeword)
{
return _duid_lookup[codeword];
}
uint8_t p25p2_duid::extract_duid(const uint8_t dibits[])
{
int duid0 = dibits[10];
int duid1 = dibits[47];
int duid2 = dibits[132];
int duid3 = dibits[169];
uint8_t v = (duid0 << 6) + (duid1 << 4) + (duid2 << 2) + duid3;
return (v);
}
|
