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
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
|
/*---------------------------------------------------------------
* Copyright (c) 2017
* Broadcom Corporation
* All Rights Reserved.
*---------------------------------------------------------------
* Permission is hereby granted, free of charge, to any person
* obtaining a copy of this software and associated
* documentation files (the "Software"), to deal in the Software
* without restriction, including without limitation the
* rights to use, copy, modify, merge, publish, distribute,
* sublicense, and/or sell copies of the Software, and to permit
* persons to whom the Software is furnished to do
* so, subject to the following conditions:
*
*
* Redistributions of source code must retain the above
* copyright notice, this list of conditions and
* the following disclaimers.
*
*
* Redistributions in binary form must reproduce the above
* copyright notice, this list of conditions and the following
* disclaimers in the documentation and/or other materials
* provided with the distribution.
*
*
* Neither the name of Broadcom Coporation,
* nor the names of its contributors may be used to endorse
* or promote products derived from this Software without
* specific prior written permission.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
* OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
* NONINFRINGEMENT. IN NO EVENT SHALL THE CONTIBUTORS OR COPYRIGHT
* HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
* WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
* ARISING FROM, OUT OF OR IN CONNECTION WITH THE
* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
* ________________________________________________________________
*
* checkisoch.cpp
*
* Test routine to test the isochronous functions
*
* by Robert J. McMahon (rjmcmahon@rjmcmahon.com, bob.mcmahon@broadcom.com)
* ------------------------------------------------------------------- */
#ifndef _GNU_SOURCE
#define _GNU_SOURCE
#endif
#include <stdio.h>
#include <stdlib.h>
#include <time.h>
#include <errno.h>
#include <string.h>
#include <math.h>
#include <unistd.h>
#include "headers.h"
#include "isochronous.hpp"
#include "delay.h"
#include "pdfs.h"
#include "util.h"
static void posttimestamp(int, int);
int main (int argc, char **argv) {
int c, count=100, frequency=100;
float mean=1e8;
float variance=3e7;
bool forceslip = false;
Isochronous::FrameCounter *fc = NULL;
while ((c = getopt(argc, argv, "c:f:m:sv:")) != -1) {
switch (c) {
case 'c':
count = atoi(optarg);
break;
case 'f':
frequency = atoi(optarg);
break;
case 'm':
mean=byte_atof(optarg);
break;
case 's':
forceslip = true;
break;
case 'v':
variance=byte_atof(optarg);
break;
case '?':
fprintf (stderr, "usage: -c <count> -f <frames per second> -m <mean> -v <variance>\n");
return 1;
default:
abort ();
}
}
fc = new Isochronous::FrameCounter(frequency);
fprintf(stdout,"Timestamping %d times at %d fps\n", count, frequency);
fflush(stdout);
while (count-- > 0) {
if (forceslip && count == 8) {
delay_loop (1000000/frequency + 10);
}
fc->wait_tick();
posttimestamp(count, (round(lognormal(mean,variance)) / (frequency * 8)));
if (fc->slip) {
fprintf(stdout,"Slip occurred\n");
fc->slip = 0;
}
}
DELETE_PTR(fc);
}
void posttimestamp (int count, int bytes) {
struct timespec t1;
double timestamp;
int err;
err = clock_gettime(CLOCK_REALTIME, &t1);
if (err < 0) {
perror("clock_getttime");
} else {
timestamp = t1.tv_sec + (t1.tv_nsec / 1000000000.0);
fprintf(stdout,"%f counter(%d), sending %d bytes\n", timestamp, count, bytes);
}
fflush(stdout);
}
|
