forked from n6il/pyDriveWire
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathdwserial.py
executable file
·81 lines (68 loc) · 1.64 KB
/
dwserial.py
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
#!/usr/local/bin/python
import serial
from dwio import DWIO
import dwlib
class DWSerial(DWIO):
def __init__(self, port, speed, rtscts=False):
DWIO.__init__(self, threaded=True)
self.port = port
self.speed = speed
self.rtscts = rtscts
self.ser = None
def isConnected(self):
return self.ser != None
def connect(self):
self.ser = serial.Serial(self.port, self.speed, timeout=1, rtscts=self.rtscts)
self.connected = True
return
def _close(self):
self.ser = None
self.connected = False
pass
#self.ser.close()
def _read(self, count=None):
if self.abort:
return ''
data = ''
#print "dwserial: read"
if count:
data = self.ser.read(count)
else:
data = self.ser.read()
if self.debug and data:
print "serread: len=%d %s"%(len(data),dwlib.canonicalize(data))
return data
def _write(self, data):
if self.abort:
return -1
if self.debug and data:
print "serwrite: len=%d %s"%(len(data),dwlib.canonicalize(data))
return self.ser.write(data)
def _in_waiting(self):
return self.ser.in_waiting
if __name__ == '__main__':
import sys
if len(sys.argv) < 2:
print("Usage: %s <port> <speed>" % (sys.argv[0]))
print('')
print('\t%s /dev/tty.usbserial-FTF4ZN9S 19200' % sys.argv[0])
print('')
sys.exit(1)
(_, port, speed) = sys.argv
ser = DWSerial(port, speed)
ser.connect()
def cleanup():
#print "main: Closing serial port."
ser.close()
import atexit
atexit.register(cleanup)
try:
while True:
wdata = raw_input()
ser.write(wdata)
print "main: Wrote %d bytes" % len(wdata)
rdata = ser.read(len(wdata))
print "main: Read %d bytes" % len(rdata)
print rdata
finally:
cleanup()