TT22

Untitled

Jan 11th, 2019
236
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.58 KB | None | 0 0
  1. import RPi.GPIO as GPIO
  2. import time
  3. import sys
  4. import atexit
  5. import socket
  6.  
  7. def at_exit():
  8. off()
  9.  
  10. atexit.register(at_exit)
  11.  
  12. def setup():
  13. GPIO.setmode(GPIO.BOARD)
  14. GPIO.setup(31,GPIO.OUT)
  15. GPIO.setup(33,GPIO.OUT)
  16. GPIO.setup(35,GPIO.OUT)
  17. GPIO.setup(37,GPIO.OUT)
  18.  
  19. def backward():
  20. GPIO.output(31,GPIO.HIGH)
  21. GPIO.output(33,GPIO.LOW)
  22.  
  23. def forward():
  24. GPIO.output(31,GPIO.LOW)
  25. GPIO.output(33,GPIO.HIGH)
  26.  
  27. def stop():
  28. GPIO.output(31,GPIO.LOW)
  29. GPIO.output(33,GPIO.LOW)
  30.  
  31. def left():
  32. GPIO.output(35,GPIO.HIGH)
  33. GPIO.output(37,GPIO.LOW)
  34.  
  35. def right():
  36. GPIO.output(35,GPIO.LOW)
  37. GPIO.output(37,GPIO.HIGH)
  38.  
  39. def middle():
  40. GPIO.output(35,GPIO.LOW)
  41. GPIO.output(37,GPIO.LOW)
  42.  
  43. def off():
  44. middle()
  45. stop()
  46. GPIO.cleanup()
  47.  
  48. def main():
  49.  
  50. setup()
  51.  
  52. UDP_IP = "192.168.1.105"
  53. UDP_PORT = 2319
  54.  
  55. sock = socket.socket(socket.AF_INET, socket.SOCK_STREAM)
  56. sock.bind((UDP_IP, UDP_PORT))
  57.  
  58. while True:
  59. sock.listen(1)
  60. connection, adresse = sock.accept()
  61. data = connection.recv(2048)
  62. print ("Received message: ", data)
  63.  
  64. if data == b"forward":
  65. forward()
  66. elif data == b"backward":
  67. backward()
  68. elif data == b"right":
  69. right()
  70. elif data == b"left":
  71. left()
  72. elif data == b"middle":
  73. middle()
  74. elif data == b"stop":
  75. stop()
  76.  
  77. if __name__ == "__main__":
  78. try:
  79. main()
  80. except KeyboardInterrupt:
  81. off()
Advertisement
Add Comment
Please, Sign In to add comment