forked from kb1isz/linDmrMaster
-
Notifications
You must be signed in to change notification settings - Fork 0
/
convbin.c
46 lines (38 loc) · 1.54 KB
/
convbin.c
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
/*
* Linux DMR Master server
Copyright (C) 2014 Wim Hofman
This program 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 2 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 General Public License for more details.
You should have received a copy of the GNU General Public License along
with this program; if not, write to the Free Software Foundation, Inc.,
51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
*/
#include "master_server.h"
bool *convertToBits(const unsigned char packet[34]) {
static bool bits[264];
unsigned char convPacket[33];
unsigned char dmrPacket[100];
int i, x;
memset(dmrPacket, 0, 100);
//bit invert
for (i = 0; i < 32; i = i + 2) {
convPacket[i] = *(packet + i + 1);
convPacket[i + 1] = *(packet + i);
if (debug == 1) sprintf(dmrPacket, "%s%02x:%02x:", dmrPacket, convPacket[i], convPacket[i + 1]);
}
convPacket[32] = *(packet + 33);
if (debug == 1) syslog(LOG_NOTICE, "[convertToBits]DMR packet:%s", dmrPacket);
//convert to bits
for (i = 0; i < 33; i++) {
for (x = 0; x < 8; x++) {
bits[(7 - x) + (8 * i)] = (convPacket[i] >> x) & 1;
}
}
return bits;
}