-
Notifications
You must be signed in to change notification settings - Fork 0
/
DO.cc
75 lines (63 loc) · 1.56 KB
/
DO.cc
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
#include <mutex>
#include <queue>
#include <string>
#include <iostream>
#include "dask.h"
#include "conio.h"
#include "DO.h"
extern std::mutex tcpSendMutex;
extern std::queue<std::string> tcpSendBuffer;
I16 cardDO;
U32 test_out_value = 1;
U32 outputs = 0;
void initDO() {
if ((cardDO=Register_Card(PCI_7234, 0)) <0 ) {
printf("Register_Card error=%d\n", cardDO);
exit(1);
}
}
void releaseDO() {
turnOffAllOutputs();
Release_Card( cardDO );
}
void turnOffAllOutputs() {
if(outputs == 0) return;
outputs = 0;
tcpSendMutex.lock();
for(int i = 0; i < 32; i++){
char buffer [4];
sprintf(buffer,"S%02d%d\r\n", i, 0);
std::string s(buffer);
tcpSendBuffer.push(s);
}
tcpSendMutex.unlock();
DO_WritePort(cardDO, 0, outputs);
printf("turned all the relays off...\n");
}
bool readOutput(int channel) {
if (channel < 0 || channel > 31) {
printf("Cannot read channel %d! It is not a valid output channel!\n", channel);
return false;
}
return (outputs >> channel) & 1U;
}
bool setOutput(int channel, bool value) {
if (channel < 0 || channel > 31) {
printf("Cannot write to channel %d! It is not a valid output channel!\n", channel);
return false;
}
if(readOutput(channel) == value) return true;
if(value) {
outputs |= ((U32) 1UL) << channel;
} else {
outputs &= ~(((U32) 1UL) << channel);
}
DO_WritePort(cardDO, 0, outputs);
char buffer [4];
sprintf(buffer,"S%02d%d\r\n", channel, value);
std::string s(buffer);
tcpSendMutex.lock();
tcpSendBuffer.push(s);
tcpSendMutex.unlock();
return true;
}