Files
tr360_ros_driver/test_radar_commands.py

63 lines
1.6 KiB
Python
Raw Permalink Normal View History

#!/usr/bin/env python3
import socket
import time
def test_radar_commands(host='192.168.1.193', port=11195):
"""测试雷达命令功能"""
print(f"Connecting to radar command server at {host}:{port}")
try:
# 连接到命令服务器
sock = socket.socket(socket.AF_INET, socket.SOCK_STREAM)
sock.connect((host, port))
# 测试命令列表
test_commands = [
"status",
"get_config",
"set_port 10195",
"start_scan",
"stop_scan",
"history"
]
for cmd in test_commands:
# 发送命令(添加回车换行)
full_cmd = cmd + "\r\n"
sock.send(full_cmd.encode())
# 接收响应
response = sock.recv(1024).decode().strip()
print(f"Command: {cmd}")
print(f"Response: {response}")
print("-" * 50)
time.sleep(0.5)
sock.close()
print("Test completed successfully!")
except Exception as e:
print(f"Error: {e}")
def test_multiple_radars():
"""测试多个雷达端口的命令功能"""
radar_ports = {
"TR360-3-60": 11195, # 10195 + 1000
"TR360-4-60": 21295 # 20295 + 1000
}
for radar_type, port in radar_ports.items():
print(f"\n=== Testing {radar_type} (port {port}) ===")
test_radar_commands(port=port)
time.sleep(1)
if __name__ == "__main__":
# 测试单个雷达
test_radar_commands()
# 测试多个雷达
# test_multiple_radars()