Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- import serial
- import time
- import KomunikacioniPodatak
- class Komunikacija:
- """spRobot = serial.Serial()"""
- def __init__ (self):
- port = '/dev/ttyACM0'
- baud = 115200
- self.spRobot = serial.Serial(port, baud, timeout = 1)
- self.spRobot.close()
- self.spRobot.open()
- if self.spRobot.isOpen():
- print(self.spRobot.name + ' is open...')
- def posaljiPorukuPovezaniSmo(self):
- self.spRobot.write("!C#".encode())
- def resetujWDT(self):
- self.spRobot.write("!R#".encode())
- def hitnoStopiraj(self):
- self.spRobot.write("!H#".encode())
- def postaviBrzinu(self, tocak, brzina):
- tekst = "!W" + tocak + hex(brzina + 2048)[2:] + "#"
- """print(tekst)"""
- self.spRobot.write(str(tekst).encode())
- def primiPodatak(self):
- """p = '0';
- while p != '#':
- print(p)
- p = self.spRobot.read(1)"""
- podatak = self.spRobot.read(1)
- print(podatak.decode())
- """if podatak[1] == 'S':
- index = int(podatak.substring(1, 1))
- duzina = int(podatak.substring(2, 2))
- print(index)
- print(duzina)
- return KomunikacioniPodatak(indeks=index, daljina=duzina)"""
- return 0
- if __name__=="__main__":
- k1 = Komunikacija()
- x = 0
- k1.posaljiPorukuPovezaniSmo()
- x = 0;
- """KomunikacioniPodatak k;"""
- while x < 1:
- time.sleep(0.01)
- k1.resetujWDT()
- k1.postaviBrzinu(tocak='R', brzina=40)
- k1.postaviBrzinu(tocak='R', brzina=40)
- print(x)
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement