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
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
|
/* $Id: main.c,v 1.3 2007/03/15 14:37:58 pjetur Exp $
***************************************************************************
* Copyright (C) 2004 by Nicolas Sutre *
* nicolas.sutre@free.fr *
* *
* Copyright (C) 2005 by Bob Dempsey *
* bdempsey_64@msn.com *
* *
* Copyright (C) 2005 by Julien Etelain and Edward Nys *
* Converted to C *
* Commented and improved by Julien Etelain <julien.etelain@utbm.fr> *
* Edward Nys <edward.ny@utbm.fr> *
* *
* Copyleft (L) 2005 by Sven Lindberg *
* k8055@k8055.mine.nu *
* Give it up already :) Simplified (read improved..) and included *
* with k8055 lib and with a functional man page *
* *
* 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., *
* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
***************************************************************************/
#include <string.h>
#include <stdio.h>
#include <usb.h>
#include <assert.h>
#include <sys/time.h>
#include "k8055.h"
#define STR_BUFF 256
#define false 0
#define true 1
int debug = 0;
int ia1 = -1;
int ia2 = -1;
int id8 = -1;
int ipid = 0;
int numread = 1;
int dbt1 = -1; // (-1 => not to set)
int dbt2 = -1; // (-1 => not to set)
int resetcnt1 = false;
int resetcnt2 = false;
int delay = 0;
/*
Convert a string on n chars to an integer
Return 1 on sucess
0 on failure (non number)
*/
int Convert_StringToInt(char *text, int *i)
{
return sscanf(text, "%d", i);
}
/*
Write help to standard output
*/
void display_help ( char *params[] ) {
printf("K8055 version %s MrBrain Build\n",version());
printf("Copyright (C) 2004 by Nicolas Sutre\n");
printf("Copyright (C) 2005 by Bob Dempsey\n");
printf("Copyright (C) 2005 by Julien Etelain and Edward Nys\n");
printf("Copyleft (L) 2005 by Sven Lindberg\n");
printf("\n");
printf("Syntax : %s [-p:(number)] [-d:(value)] [-a1:(value)] [-a2:(value)]\n",params[0]);
printf(" [-num:(number) [-delay:(number)] [-dbt1:(value)]\n");
printf(" [-dbt2:(value)] [-reset1] [-reset2] [-debug]\n");
printf(" -p:(number) Set board number\n");
printf(" -d:(value) Set digital output value (8 bits in decimal)\n");
printf(" -a1:(value) Set analog output 1 value (0-255)\n");
printf(" -a2:(value) Set analog output 2 value (0-255)\n");
printf(" -num:(number) Set number of measures\n");
printf(" -delay:(number) Set delay between two measure (in msec)\n");
printf(" -dbt1:(value) Set debounce time for counter 1 (in msec)\n");
printf(" -dbt2:(value) Set debounce time for counter 2 (in msec)\n");
printf(" -reset1 Reset counter 1\n");
printf(" -reset2 Reset counter 2\n");
printf(" -debug Activate debug mode\n");
printf("Example : %s -p:1 -d:147 -a1:25 -a2:203\n",params[0]);
printf("\n");
printf("Output : (timestamp);(digital);(analog 1);(analog 2);(counter 1);(counter 2)\n");
printf("Note : timestamp is the number of msec when data is read since program start\n");
printf("Example : 499;16;128;230;9;8\n");
printf("499 : Measure done 499 msec after program start\n");
}
/*
Read arguments, and store values
Return true if arguments are valid
else return false
*/
int read_param(int argc,char *params[])
{
int erreurParam = false;
int i;
ipid = 0;
for (i=1; i<argc;i++)
{
if ( !strncmp(params[i],"-p:",3) &&
!Convert_StringToInt(params[i]+3,&ipid) ) erreurParam = true;
else
if ( !strncmp(params[i],"-a1:",4) &&
!Convert_StringToInt(params[i]+4,&ia1) ) erreurParam = true;
else
if ( !strncmp(params[i],"-a2:",4) &&
!Convert_StringToInt(params[i]+4,&ia2) ) erreurParam = true;
else
if ( !strncmp(params[i],"-d:",3) &&
!Convert_StringToInt(params[i]+3,&id8) ) erreurParam = true;
else
if ( !strncmp(params[i],"-num:",5) &&
!Convert_StringToInt(params[i]+5,&numread) ) erreurParam = true;
else
if ( !strncmp(params[i],"-delay:",7) &&
!Convert_StringToInt(params[i]+7,&delay) ) erreurParam = true;
else
if ( !strncmp(params[i],"-dbt1:",6) &&
!Convert_StringToInt(params[i]+6,&dbt1) ) erreurParam = true;
else
if ( !strncmp(params[i],"-dbt2:",6) &&
!Convert_StringToInt(params[i]+6,&dbt2) ) erreurParam = true;
else
if ( !strcmp(params[i],"-debug") ){
debug = 1;
set_debug_on();
}
else
if ( !strcmp(params[i],"-reset1") ) resetcnt1 = true;
else
if ( !strcmp(params[i],"-reset2") ) resetcnt2 = true;
else
if ( !strcmp(params[i],"--help") ) {
display_help(params);
return false;
}
}
/*
Send parameters to standart error
*/
if ( debug )
fprintf(stderr,"Parameters : Card=%d Analog1=%d Analog2=%d Digital=%d\n",ipid,ia1,ia2,id8);
if (ipid<0 || ipid>3){
printf("Invalid board address!\n");
return -1;
}
if (erreurParam)
{
printf("Invalid or incomplete options\n");
display_help(params);
return false;
}
return true;
}
/*
Give current timestamp in miliseconds
*/
inline unsigned long int time_msec ( void ) {
struct timeval t; struct timezone tz;
gettimeofday (&t,&tz);
return (1000*t.tv_sec)+(t.tv_usec/1000);
}
int main (int argc,char *params[])
{
int i,result;
long d=0;
long a1=0,a2=0;
long c1=0, c2=0;
unsigned long int start,mstart=0,lastcall=0;
start = time_msec();
/*
Load parameters
If parameters are valid continue
*/
if (read_param(argc,params))
{
/*
Initialise USB system
and enable debug mode
if ( debug )
usb_set_debug(2);
*/
/*
Search the device
*/
struct k8055_dev dev;
if ( open_device(&dev, ipid)<0 ) {
printf("Could not open the k8055 (port:%d)\nPlease ensure that the device is correctly connected.\n",ipid);
return (-1);
} else {
if ( resetcnt1 )
reset_counter(&dev,1);
if ( resetcnt2 )
reset_counter(&dev,2);
if ( dbt1 != -1 )
set_counter_debounce_time(&dev,1,dbt1);
if ( dbt2 != -1 )
set_counter_debounce_time(&dev,2,dbt1);
if ((ia1!=-1) && (ia2!=-1) && (id8!=-1)) {
result = set_all_values(&dev,id8,ia1,ia2);
if (debug) printf("SetAllValues=%d - Digital:%d, analog1:%d, analog2:%d\n",result,id8,ia1,ia2);
}
else if ((id8 != -1) && (ia1!=-1)) {
result = set_all_values(&dev,id8,ia1,0);
if (debug) printf("SetAllValues=%d - Digital:%d, analog1:%d\n",result,id8,ia1);
}
else if ((id8 != -1) && (ia2!=-1)) {
result = set_all_values(&dev,id8,0,ia2);
if (debug) printf("SetAllValues=%d - Digital:%d, analog2:%d\n",result,id8,ia2);
}
else if ((ia1 != -1) && (ia2!=-1)) {
result = set_all_values(&dev,0,ia1,ia2);
if (debug) printf("SetAllValues=%d - analog1:%d, analog2:%d\n",result,ia1,ia2);
}
else {
if (ia1!=-1) {
result=output_analog_channel(&dev,1,ia1);
if (debug) printf("Set analog1:%d=>%d\n",ia1,result);
}
if (ia2!=-1) {
result=output_analog_channel(&dev,2,ia2);
if (debug) printf("Set analog2:%d=>%d\n",ia2,result);
}
if (id8!=-1) {
result=write_all_digital(&dev,(long)id8);
if (debug) printf("Set digital:%d=>%d\n",id8,result);
}
}
mstart = time_msec(); // Measure start
for (i=0; i<numread; i++) {
if ( delay ) {
// Wait until next measure
while ( time_msec()-mstart < i*delay );
}
read_all_values( &dev,&d,&a1,&a2,&c1,&c2);
/* ReadAllAnalog(&a1,&a2);
d=ReadAllDigital();
c1=ReadCounter(1);
c2=ReadCounter(2);
*/
lastcall = time_msec();
printf("%d;%d;%d;%d;%d;%d\n", (int)(lastcall-start),(int)d, (int)a1, (int)a2,(int)c1,(int)c2 );
}
close_device(&dev);
}
}
return 0;
}
|
