-
Notifications
You must be signed in to change notification settings - Fork 10
/
sppextract-samplecount.c
98 lines (79 loc) · 1.95 KB
/
sppextract-samplecount.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
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
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <arpa/inet.h>
#include <errno.h>
#include <sys/mman.h>
#include <unistd.h>
struct spp_primary_header {
union {
struct {
uint16_t apid:11;
uint16_t sec:1;
uint16_t packet:1;
uint16_t version:3;
};
uint16_t half1;
};
union {
struct {
uint16_t seq_flags:2;
uint16_t seq_count:14;
};
uint16_t half2;
};
uint16_t size;
};
int
main(int argc, char *argv[])
{
const uint8_t *data;
struct spp_primary_header hdr;
struct stat sbuf;
int fd;
uint16_t apid;
unsigned int p, actual_p = 0;
unsigned int i;
uint64_t ptr = 0;
if (argc != 2) {
fprintf(stderr, "Usage: %s <input>\n", argv[0]);
exit(EXIT_FAILURE);
}
if (stat(argv[1], &sbuf) == -1) {
fprintf(stderr, "%s: cannot stat %s: %s\n", argv[0], argv[1], strerror(errno));
exit(EXIT_FAILURE);
}
if ((fd = open(argv[1], O_RDONLY)) == -1) {
fprintf(stderr, "%s: cannot open %s: %s\n", argv[0], argv[1], strerror(errno));
exit(EXIT_FAILURE);
}
data = mmap(NULL, sbuf.st_size, PROT_READ, MAP_PRIVATE, fd, 0);
if (data == (const uint8_t *) -1) {
fprintf(stderr, "%s: mmap failed: %s\n", argv[0], argv[1]);
exit(EXIT_FAILURE);
}
close(fd);
p = 0;
while (p < sbuf.st_size) {
ptr = *(const uint64_t *) (data + p);
p += sizeof(uint64_t);
hdr = *(const struct spp_primary_header *) (data + p);
p += sizeof(struct spp_primary_header);
hdr.half1 = ntohs(hdr.half1);
hdr.half2 = ntohs(hdr.half2);
hdr.size = ntohs(hdr.size) + 1;
apid = hdr.apid;
if (p + hdr.size > sbuf.st_size)
break;
if (apid != 0x7ff) {
printf("%lld,\"%04x\",\"%04x\",%d,%d,\"", ptr, hdr.seq_count, hdr.apid, hdr.seq_count, hdr.size);
for (i = 0; i < hdr.size; ++i)
printf("%02x ", data[p + i]);
printf("\"\n");
}
p += hdr.size;
}
return 0;
}