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
|
#include <stdio.h>
#include <comedilib.h>
#include <fcntl.h>
#include <unistd.h>
#include <sys/ioctl.h>
#include <errno.h>
#include <getopt.h>
#include <ctype.h>
#include <math.h>
#include <sys/time.h>
#include <string.h>
#include "comedi_test.h"
int test_insn_read_time(void)
{
comedi_insn insn[3];
comedi_insnlist il;
lsampl_t t1[2],t2[2];
lsampl_t data;
long diffus;
int save_errno;
int ret;
printf("rev 1\n");
if(comedi_get_subdevice_type(device,subdevice)==COMEDI_SUBD_UNUSED){
printf("not applicable\n");
return 0;
}
memset(&il,0,sizeof(il));
memset(insn,0,sizeof(insn));
il.n_insns = 3;
il.insns = insn;
insn[0].insn = INSN_GTOD;
insn[0].n=2;
insn[0].data = t1;
insn[1].subdev = subdevice;
insn[1].insn = INSN_READ;
insn[1].n = 1;
insn[1].chanspec = CR_PACK(0,0,0);
insn[1].data = &data;
insn[2].insn = INSN_GTOD;
insn[2].n=2;
insn[2].data = t2;
ret = comedi_do_insnlist(device,&il);
save_errno = errno;
printf("comedi_do_insn: %d\n",ret);
if(ret<0){
printf("W: comedi_do_insn: errno=%d %s\n",save_errno,strerror(save_errno));
}
if(ret<2){
printf("W: comedi_do_insn: returned %d (expected 3)\n",ret);
}
if (t2[0] >= t1[0]) {
diffus = (long)(t2[0] - t1[0]);
} else {
diffus = -(long)(t1[0] - t2[0]);
}
diffus *= 1000000;
if (t2[1] >= t1[1]) {
diffus += (long)(t2[1] - t1[1]);
} else {
diffus -= (long)(t1[1] - t2[1]);
}
printf("read time: %ld us\n", diffus);
return 0;
}
|
