Advertisement
Guest User

Komunikacija2

a guest
Jul 21st, 2018
65
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.94 KB | None | 0 0
  1. import serial
  2. import time
  3. import KomunikacioniPodatak
  4.  
  5. class Komunikacija:
  6. """spRobot = serial.Serial()"""
  7. def __init__ (self):
  8. port = '/dev/ttyACM0'
  9. baud = 115200
  10. self.spRobot = serial.Serial(port, baud, timeout = 1)
  11. self.spRobot.close()
  12. self.spRobot.open()
  13. if self.spRobot.isOpen():
  14. print(self.spRobot.name + ' is open...')
  15. def posaljiPorukuPovezaniSmo(self):
  16. self.spRobot.write("!C#".encode())
  17. def resetujWDT(self):
  18. self.spRobot.write("!R#".encode())
  19. def hitnoStopiraj(self):
  20. self.spRobot.write("!H#".encode())
  21. def postaviBrzinu(self, tocak, brzina):
  22. tekst = "!W" + tocak + hex(brzina + 2048)[2:] + "#"
  23. """print(tekst)"""
  24. self.spRobot.write(str(tekst).encode())
  25. def primiPodatak(self):
  26. """p = '0';
  27. while p != '#':
  28. print(p)
  29. p = self.spRobot.read(1)"""
  30. podatak = self.spRobot.read(1)
  31. print(podatak.decode())
  32. """if podatak[1] == 'S':
  33. index = int(podatak.substring(1, 1))
  34. duzina = int(podatak.substring(2, 2))
  35. print(index)
  36. print(duzina)
  37. return KomunikacioniPodatak(indeks=index, daljina=duzina)"""
  38. return 0
  39.  
  40. if __name__=="__main__":
  41. k1 = Komunikacija()
  42. x = 0
  43. k1.posaljiPorukuPovezaniSmo()
  44. x = 0;
  45. """KomunikacioniPodatak k;"""
  46. while x < 1:
  47. time.sleep(0.01)
  48. k1.resetujWDT()
  49. k1.postaviBrzinu(tocak='R', brzina=40)
  50. k1.postaviBrzinu(tocak='R', brzina=40)
  51. print(x)
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement