run_udp_server.py 2.7 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980
  1. # SPDX-FileCopyrightText: 2022 Espressif Systems (Shanghai) CO LTD
  2. # SPDX-License-Identifier: Unlicense OR CC0-1.0
  3. import argparse
  4. import socket
  5. from threading import Event, Thread
  6. DEF_PORT = 3333
  7. class UdpServer:
  8. def __init__(self, port, family_addr, persist=False, timeout=60): # type: ignore
  9. self.port = port
  10. self.family_addr = family_addr
  11. self.socket = socket.socket(family_addr, socket.SOCK_DGRAM)
  12. self.socket.setsockopt(socket.SOL_SOCKET, socket.SO_REUSEADDR, 1)
  13. self.socket.settimeout(timeout)
  14. self.shutdown = Event()
  15. self.persist = persist
  16. self.server_thread = None
  17. def __enter__(self): # type: ignore
  18. try:
  19. self.socket.bind(('', self.port))
  20. except socket.error as e:
  21. print('Bind failed:{}'.format(e))
  22. raise
  23. print('Starting server on port={} family_addr={}'.format(self.port, self.family_addr))
  24. self.server_thread = Thread(target=self.run_server)
  25. self.server_thread.start()
  26. return self
  27. def __exit__(self, exc_type, exc_value, traceback): # type: ignore
  28. if self.persist:
  29. sock = socket.socket(self.family_addr, socket.SOCK_DGRAM)
  30. sock.sendto(b'Stop', ('localhost', self.port))
  31. sock.close()
  32. self.shutdown.set()
  33. self.server_thread.join()
  34. self.socket.close()
  35. def run_server(self) -> None:
  36. while not self.shutdown.is_set():
  37. try:
  38. data, addr = self.socket.recvfrom(1024)
  39. print(addr)
  40. if not data:
  41. return
  42. data = data.decode()
  43. print('Reply[' + addr[0] + ':' + str(addr[1]) + '] - ' + data)
  44. reply = 'OK: ' + data
  45. self.socket.sendto(reply.encode(), addr)
  46. except socket.timeout:
  47. print(f'socket recvfrom timeout ({self.socket.timeout}s)')
  48. except socket.error as e:
  49. print('Running server failed:{}'.format(e))
  50. raise
  51. if not self.persist:
  52. break
  53. def main() -> None:
  54. parser = argparse.ArgumentParser()
  55. parser.add_argument('--port', default=DEF_PORT, type=int, help='UDP server port')
  56. parser.add_argument('--ipv6', action='store_true', help='Create IPv6 server.')
  57. parser.add_argument('--timeout', default=10, type=int, help='socket recvfrom timeout.')
  58. args = parser.parse_args()
  59. if args.ipv6:
  60. family = socket.AF_INET6
  61. else:
  62. family = socket.AF_INET
  63. with UdpServer(args.port, family, persist=True, timeout=args.timeout):
  64. input('Server Running. Press Enter or CTRL-C to exit...\n')
  65. if __name__ == '__main__':
  66. main()