forked from espressif/esp-protocols
173 lines
6.8 KiB
Python
173 lines
6.8 KiB
Python
# SPDX-FileCopyrightText: 2022 Espressif Systems (Shanghai) CO LTD
|
|
# SPDX-License-Identifier: Unlicense OR CC0-1.0
|
|
import re
|
|
import select
|
|
import socket
|
|
import struct
|
|
import subprocess
|
|
import time
|
|
from threading import Event, Thread
|
|
|
|
import dpkt
|
|
import dpkt.dns
|
|
|
|
|
|
def get_dns_query_for_esp(esp_host):
|
|
dns = dpkt.dns.DNS(
|
|
b'\x00\x00\x01\x00\x00\x01\x00\x00\x00\x00\x00\x00\x00\x00\x01\x00\x01'
|
|
)
|
|
dns.qd[0].name = esp_host + u'.local'
|
|
print('Created query for esp host: {} '.format(dns.__repr__()))
|
|
return dns.pack()
|
|
|
|
|
|
def get_dns_answer_to_mdns(tester_host):
|
|
dns = dpkt.dns.DNS(
|
|
b'\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00'
|
|
)
|
|
dns.op = dpkt.dns.DNS_QR | dpkt.dns.DNS_AA
|
|
dns.rcode = dpkt.dns.DNS_RCODE_NOERR
|
|
arr = dpkt.dns.DNS.RR()
|
|
arr.cls = dpkt.dns.DNS_IN
|
|
arr.type = dpkt.dns.DNS_A
|
|
arr.name = tester_host
|
|
arr.ip = socket.inet_aton('127.0.0.1')
|
|
dns.an.append(arr)
|
|
print('Created answer to mdns query: {} '.format(dns.__repr__()))
|
|
return dns.pack()
|
|
|
|
|
|
def get_dns_answer_to_mdns_lwip(tester_host, id):
|
|
dns = dpkt.dns.DNS(
|
|
b'\x5e\x39\x84\x00\x00\x01\x00\x01\x00\x00\x00\x00\x0a\x64\x61\x76\x69\x64'
|
|
b'\x2d\x63\x6f\x6d\x70\x05\x6c\x6f\x63\x61\x6c\x00\x00\x01\x00\x01\xc0\x0c'
|
|
b'\x00\x01\x00\x01\x00\x00\x00\x0a\x00\x04\xc0\xa8\x0a\x6c')
|
|
dns.qd[0].name = tester_host
|
|
dns.an[0].name = tester_host
|
|
dns.an[0].ip = socket.inet_aton('127.0.0.1')
|
|
dns.an[0].rdata = socket.inet_aton('127.0.0.1')
|
|
dns.id = id
|
|
print('Created answer to mdns (lwip) query: {} '.format(dns.__repr__()))
|
|
return dns.pack()
|
|
|
|
|
|
def mdns_server(esp_host, events):
|
|
UDP_IP = '0.0.0.0'
|
|
UDP_PORT = 5353
|
|
MCAST_GRP = '224.0.0.251'
|
|
TESTER_NAME = u'tinytester.local'
|
|
TESTER_NAME_LWIP = u'tinytester-lwip.local'
|
|
QUERY_TIMEOUT = 0.2
|
|
sock = socket.socket(socket.AF_INET, socket.SOCK_DGRAM)
|
|
sock.setsockopt(socket.SOL_SOCKET, socket.SO_REUSEADDR, 1)
|
|
sock.setsockopt(socket.SOL_SOCKET, socket.SO_REUSEPORT, 1)
|
|
sock.setblocking(False)
|
|
sock.bind((UDP_IP, UDP_PORT))
|
|
mreq = struct.pack('4sl', socket.inet_aton(MCAST_GRP), socket.INADDR_ANY)
|
|
sock.setsockopt(socket.IPPROTO_IP, socket.IP_ADD_MEMBERSHIP, mreq)
|
|
last_query_timepoint = time.time()
|
|
while not events['stop'].is_set():
|
|
try:
|
|
current_time = time.time()
|
|
if current_time - last_query_timepoint > QUERY_TIMEOUT:
|
|
last_query_timepoint = current_time
|
|
if not events['esp_answered'].is_set():
|
|
sock.sendto(get_dns_query_for_esp(esp_host),
|
|
(MCAST_GRP, UDP_PORT))
|
|
if not events['esp_delegated_answered'].is_set():
|
|
sock.sendto(get_dns_query_for_esp(esp_host + '-delegated'),
|
|
(MCAST_GRP, UDP_PORT))
|
|
timeout = max(
|
|
0, QUERY_TIMEOUT - (current_time - last_query_timepoint))
|
|
read_socks, _, _ = select.select([sock], [], [], timeout)
|
|
if not read_socks:
|
|
continue
|
|
data, addr = sock.recvfrom(1024)
|
|
dns = dpkt.dns.DNS(data)
|
|
if len(dns.qd) > 0 and dns.qd[0].type == dpkt.dns.DNS_A:
|
|
if dns.qd[0].name == TESTER_NAME:
|
|
print('Received query: {} '.format(dns.__repr__()))
|
|
sock.sendto(get_dns_answer_to_mdns(TESTER_NAME),
|
|
(MCAST_GRP, UDP_PORT))
|
|
elif dns.qd[0].name == TESTER_NAME_LWIP:
|
|
print('Received query: {} '.format(dns.__repr__()))
|
|
sock.sendto(
|
|
get_dns_answer_to_mdns_lwip(TESTER_NAME_LWIP, dns.id),
|
|
addr)
|
|
if len(dns.an) > 0 and dns.an[0].type == dpkt.dns.DNS_A:
|
|
print('Received answer from {}'.format(dns.an[0].name))
|
|
if dns.an[0].name == esp_host + u'.local':
|
|
print('Received answer to esp32-mdns query: {}'.format(
|
|
dns.__repr__()))
|
|
events['esp_answered'].set()
|
|
if dns.an[0].name == esp_host + u'-delegated.local':
|
|
print('Received answer to esp32-mdns-delegate query: {}'.
|
|
format(dns.__repr__()))
|
|
events['esp_delegated_answered'].set()
|
|
except socket.timeout:
|
|
break
|
|
except dpkt.UnpackError:
|
|
continue
|
|
|
|
|
|
def test_examples_protocol_mdns(dut):
|
|
"""
|
|
steps: |
|
|
1. obtain IP address + init mdns example
|
|
2. get the dut host name (and IP address)
|
|
3. check the mdns name is accessible
|
|
4. check DUT output if mdns advertized host is resolved
|
|
"""
|
|
|
|
specific_host = dut.expect(re.compile(
|
|
b'mdns hostname set to: \[(.*?)\]')).group(1).decode() # noqa: W605
|
|
|
|
mdns_server_events = {
|
|
'stop': Event(),
|
|
'esp_answered': Event(),
|
|
'esp_delegated_answered': Event()
|
|
}
|
|
mdns_responder = Thread(target=mdns_server,
|
|
args=(str(specific_host), mdns_server_events))
|
|
ip_address = dut.expect(
|
|
re.compile(b'IPv4 address:([a-zA-Z0-9]*).*')).group(1).decode()
|
|
print('Connected to AP with IP: {}'.format(ip_address))
|
|
try:
|
|
# 3. check the mdns name is accessible.
|
|
mdns_responder.start()
|
|
if not mdns_server_events['esp_answered'].wait(timeout=30):
|
|
raise ValueError(
|
|
'Test has failed: did not receive mdns answer within timeout')
|
|
if not mdns_server_events['esp_delegated_answered'].wait(timeout=30):
|
|
raise ValueError(
|
|
'Test has failed: did not receive mdns answer for delegated host within timeout'
|
|
)
|
|
# 4. check DUT output if mdns advertized host is resolved
|
|
dut.expect(
|
|
re.compile(
|
|
b'mdns-test: Query A: tinytester.local resolved to: 127.0.0.1')
|
|
)
|
|
dut.expect(
|
|
re.compile(
|
|
b'mdns-test: gethostbyname: tinytester-lwip.local resolved to: 127.0.0.1'
|
|
))
|
|
dut.expect(
|
|
re.compile(
|
|
b'mdns-test: getaddrinfo: tinytester-lwip.local resolved to: 127.0.0.1'
|
|
))
|
|
# 5. check the DUT answers to `dig` command
|
|
dig_output = subprocess.check_output([
|
|
'dig', '+short', '-p', '5353', '@224.0.0.251',
|
|
'{}.local'.format(specific_host)
|
|
])
|
|
print('Resolving {} using "dig" succeeded with:\n{}'.format(
|
|
specific_host, dig_output))
|
|
if not ip_address.encode('utf-8') in dig_output:
|
|
raise ValueError(
|
|
'Test has failed: Incorrectly resolved DUT hostname using dig'
|
|
"Output should've contained DUT's IP address:{}".format(
|
|
ip_address))
|
|
finally:
|
|
mdns_server_events['stop'].set()
|
|
mdns_responder.join()
|