-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy patharduino_cannon_driver.py
69 lines (63 loc) · 2 KB
/
arduino_cannon_driver.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
#!/usr/bin/env python
# -*- coding: utf-8 -*-
#
# arduino_cannon_driver.py
#
# Copyright 2020 mkz <mkz@mkVostroUbn>
#
# 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., 51 Franklin Street, Fifth Floor, Boston,
# MA 02110-1301, USA.
#
#
import serial
import time
class CannonDriver:
def __init__(self, device, baudrate):
self.device = device
self.baudrate = baudrate
self.devReady = False
def openPort(self):
try:
self.port = serial.Serial(self.device, baudrate=self.baudrate, timeout=3.0)
self.devReady = True
except serial.SerialException as err:
print(format(err))
self.devReady = False
def sendCommand(self,command):
if self.devReady:
self.port.write(command.encode())
else:
print("Port Not Open")
def getStandartCannonDriver():
myCannon = CannonDriver("/dev/ttyUSB0", 9600)
myCannon.openPort()
return myCannon
def testUSB():
port = serial.Serial("/dev/ttyUSB0", baudrate=9600, timeout=3.0)
i = 0
while i< 8:
stratum = "UP " + str(i*10) + "\n"
port.write(stratum.encode())
i += 1
#rcv = port.read(10)
#print (rcv)
time.sleep(1)
#port.write("\r\nYou sent:" + repr(rcv))
def main(args):
testUSB()
return 0
if __name__ == '__main__':
import sys
sys.exit(main(sys.argv))