253 lines
10 KiB
Python
253 lines
10 KiB
Python
|
import socket
|
|||
|
|
import struct
|
|||
|
|
import random
|
|||
|
|
import time
|
|||
|
|
import threading
|
|||
|
|
from datetime import datetime, timedelta
|
|||
|
|
|
|||
|
|
# 报文类型常量
|
|||
|
|
MSG_DEBUG = 0
|
|||
|
|
MSG_LVDS = 1
|
|||
|
|
MSG_CAN = 2
|
|||
|
|
MSG_AD9361_CTRL = 3
|
|||
|
|
MSG_WAVE_CTRL = 4
|
|||
|
|
MSG_TEST_PARAM_CTRL = 5
|
|||
|
|
MSG_TEST_WAVE_UPLOAD = 6
|
|||
|
|
MSG_GPS = 7
|
|||
|
|
MSG_STATUS_MONITOR = 8
|
|||
|
|
MSG_PROTO_PARAM_CTRL = 9
|
|||
|
|
MSG_DATA_UPLOAD = 10
|
|||
|
|
MSG_DATA_COLLECT = 11
|
|||
|
|
MSG_DEMOD_DATA = 12
|
|||
|
|
MSG_NOTIFICATION = 13
|
|||
|
|
|
|||
|
|
# 解调器编号常量
|
|||
|
|
VDES_DEMOD_RANGE = (0, 3) # VDES解调器编号0-3
|
|||
|
|
AIS_DEMOD_RANGE = (4, 5) # AIS解调器编号4-5
|
|||
|
|
|
|||
|
|
# 长江入海口坐标范围 (31.0°N - 31.5°N, 121.5°E - 122.0°E)
|
|||
|
|
YANGTZE_DELTA_CENTER = (31.23, 121.77) # 上海附近
|
|||
|
|
DELTA_RANGE = 0.05 # ±0.05度 ≈ 5海里
|
|||
|
|
|
|||
|
|
class VDESServer:
|
|||
|
|
def __init__(self, host='localhost', port=10):
|
|||
|
|
self.host = host
|
|||
|
|
self.port = port
|
|||
|
|
self.header = b'####'
|
|||
|
|
self.running = False
|
|||
|
|
self.server_socket = None
|
|||
|
|
self.ship_mmsi = 123456789 # 船舶MMSI
|
|||
|
|
|
|||
|
|
def start(self):
|
|||
|
|
"""启动TCP服务器"""
|
|||
|
|
self.server_socket = socket.socket(socket.AF_INET, socket.SOCK_STREAM)
|
|||
|
|
self.server_socket.bind((self.host, self.port))
|
|||
|
|
self.server_socket.listen(1)
|
|||
|
|
self.running = True
|
|||
|
|
print(f"VDES Server started on {self.host}:{self.port}")
|
|||
|
|
|
|||
|
|
# 接受客户端连接
|
|||
|
|
client_socket, addr = self.server_socket.accept()
|
|||
|
|
print(f"Connected by {addr}")
|
|||
|
|
|
|||
|
|
# 启动接收线程和定时发送线程
|
|||
|
|
recv_thread = threading.Thread(target=self.handle_client, args=(client_socket,))
|
|||
|
|
send_thread = threading.Thread(target=self.send_periodic_messages, args=(client_socket,))
|
|||
|
|
|
|||
|
|
recv_thread.start()
|
|||
|
|
send_thread.start()
|
|||
|
|
|
|||
|
|
recv_thread.join()
|
|||
|
|
send_thread.join()
|
|||
|
|
|
|||
|
|
def stop(self):
|
|||
|
|
"""停止服务器"""
|
|||
|
|
self.running = False
|
|||
|
|
if self.server_socket:
|
|||
|
|
self.server_socket.close()
|
|||
|
|
|
|||
|
|
def build_packet(self, msg_type, content):
|
|||
|
|
"""构建协议报文：帧头(4) + 类型(4) + 长度(4) + 内容(N)"""
|
|||
|
|
length = len(content)
|
|||
|
|
return self.header + struct.pack('>I', msg_type) + struct.pack('>I', length) + content
|
|||
|
|
|
|||
|
|
def parse_packet(self, data):
|
|||
|
|
"""解析接收到的报文"""
|
|||
|
|
if len(data) < 12 or data[:4] != self.header:
|
|||
|
|
return None, None
|
|||
|
|
|
|||
|
|
msg_type = struct.unpack('>I', data[4:8])[0]
|
|||
|
|
length = struct.unpack('>I', data[8:12])[0]
|
|||
|
|
content = data[12:12+length] if len(data) >= 12 + length else None
|
|||
|
|
return msg_type, content
|
|||
|
|
|
|||
|
|
def handle_debug_command(self, content):
|
|||
|
|
"""处理调试指令报文（类型0）"""
|
|||
|
|
cmd_type = content[0] if content else 0
|
|||
|
|
responses = {
|
|||
|
|
0: "初始化地检",
|
|||
|
|
1: "测试波形上注完成",
|
|||
|
|
2: "LVDS数据开始上注",
|
|||
|
|
3: "CAN初始化",
|
|||
|
|
4: "LVDS初始化",
|
|||
|
|
5: "AD9361重新校准",
|
|||
|
|
6: "GPS初始化"
|
|||
|
|
}
|
|||
|
|
response_msg = responses.get(cmd_type, "未知指令")
|
|||
|
|
print(f"执行调试指令: {response_msg}")
|
|||
|
|
# 返回通知报文确认
|
|||
|
|
return self.build_packet(MSG_NOTIFICATION, struct.pack('B', 0)) # 类型0: VDES协议开始执行
|
|||
|
|
|
|||
|
|
def handle_client(self, client_socket):
|
|||
|
|
"""处理客户端请求"""
|
|||
|
|
while self.running:
|
|||
|
|
try:
|
|||
|
|
data = client_socket.recv(32768)
|
|||
|
|
if not data:
|
|||
|
|
break
|
|||
|
|
|
|||
|
|
msg_type, content = self.parse_packet(data)
|
|||
|
|
if msg_type is None:
|
|||
|
|
continue
|
|||
|
|
|
|||
|
|
# 根据报文类型处理
|
|||
|
|
if msg_type == MSG_DEBUG:
|
|||
|
|
response = self.handle_debug_command(content)
|
|||
|
|
elif msg_type == MSG_AD9361_CTRL:
|
|||
|
|
response = self.build_packet(MSG_NOTIFICATION, struct.pack('B', 7)) # AD9361状态更新
|
|||
|
|
else:
|
|||
|
|
response = self.build_packet(MSG_NOTIFICATION, struct.pack('B', 3)) # 通用确认
|
|||
|
|
|
|||
|
|
client_socket.send(response)
|
|||
|
|
except Exception as e:
|
|||
|
|
print(f"处理错误: {e}")
|
|||
|
|
break
|
|||
|
|
|
|||
|
|
def send_periodic_messages(self, client_socket):
|
|||
|
|
"""定时发送状态监控和GPS报文"""
|
|||
|
|
while self.running:
|
|||
|
|
try:
|
|||
|
|
# 每秒发送GPS数据（类型7）
|
|||
|
|
gps_data = self.generate_gps_data()
|
|||
|
|
client_socket.send(self.build_packet(MSG_GPS, gps_data))
|
|||
|
|
|
|||
|
|
# 每秒发送状态监控（类型8）
|
|||
|
|
status_data = bytes([random.randint(0, 100) for _ in range(50)]) # 随机状态数据
|
|||
|
|
client_socket.send(self.build_packet(MSG_STATUS_MONITOR, status_data))
|
|||
|
|
|
|||
|
|
# 每5秒发送解调数据（类型12）
|
|||
|
|
if int(time.time()) % 5 == 0:
|
|||
|
|
demod_data = self.generate_demod_data()
|
|||
|
|
client_socket.send(self.build_packet(MSG_DEMOD_DATA, demod_data))
|
|||
|
|
|
|||
|
|
time.sleep(1)
|
|||
|
|
except Exception as e:
|
|||
|
|
print(f"发送错误: {e}")
|
|||
|
|
break
|
|||
|
|
|
|||
|
|
def generate_gps_data(self):
|
|||
|
|
"""生成长江入海口附近的GPS数据"""
|
|||
|
|
# 在长江入海口附近随机生成位置
|
|||
|
|
lat = YANGTZE_DELTA_CENTER[0] + random.uniform(-DELTA_RANGE, DELTA_RANGE)
|
|||
|
|
lon = YANGTZE_DELTA_CENTER[1] + random.uniform(-DELTA_RANGE, DELTA_RANGE)
|
|||
|
|
|
|||
|
|
# 转换为度分格式*10000000
|
|||
|
|
lat_int = int(lat * 10000000)
|
|||
|
|
lon_int = int(lon * 10000000)
|
|||
|
|
|
|||
|
|
# 其他GPS数据字段
|
|||
|
|
utc_time = int((datetime.utcnow() - datetime(1980, 1, 6)).total_seconds())
|
|||
|
|
altitude = random.randint(-10, 50) # 海拔高度（米）
|
|||
|
|
used_satellites = random.randint(5, 12)
|
|||
|
|
gps_satellites = random.randint(4, 8)
|
|||
|
|
beidou_satellites = random.randint(4, 8)
|
|||
|
|
gps_status = random.randint(1, 4) # GPS状态
|
|||
|
|
pos_mode = random.randint(1, 3) # 定位模式
|
|||
|
|
hdop = random.randint(10, 50) # 水平精度因子
|
|||
|
|
speed = random.randint(0, 2000) # 运动速度 (0.01节)
|
|||
|
|
course = random.randint(0, 35900) # 运动方向 (度*100)
|
|||
|
|
|
|||
|
|
# 打包GPS数据
|
|||
|
|
return struct.pack('>Q', utc_time) + \
|
|||
|
|
struct.pack('>i', lon_int) + \
|
|||
|
|
struct.pack('>i', lat_int) + \
|
|||
|
|
struct.pack('>i', altitude) + \
|
|||
|
|
struct.pack('>H', used_satellites) + \
|
|||
|
|
struct.pack('>H', gps_satellites) + \
|
|||
|
|
struct.pack('>H', beidou_satellites) + \
|
|||
|
|
struct.pack('B', gps_status) + \
|
|||
|
|
struct.pack('B', pos_mode) + \
|
|||
|
|
struct.pack('>I', hdop) + \
|
|||
|
|
struct.pack('>I', speed) + \
|
|||
|
|
struct.pack('>I', course)
|
|||
|
|
|
|||
|
|
def generate_demod_data(self):
|
|||
|
|
"""生成解调数据报文（类型12）"""
|
|||
|
|
demodulator_id = random.randint(0, 5)
|
|||
|
|
msg_type = 12 # 固定值12
|
|||
|
|
satellite_id = random.randint(1, 255)
|
|||
|
|
demod_data = struct.pack('B', msg_type) + struct.pack('B', satellite_id) + struct.pack('B', demodulator_id)
|
|||
|
|
|
|||
|
|
# 根据解调器编号生成数据
|
|||
|
|
if VDES_DEMOD_RANGE[0] <= demodulator_id <= VDES_DEMOD_RANGE[1]:
|
|||
|
|
# VDES解调器 (0-3): 使用M.2092-1 Annex5格式
|
|||
|
|
msg_id = random.choice([10, 11, 12, 20, 21])
|
|||
|
|
content = struct.pack('B', msg_id) + os.urandom(20) # 随机生成20字节数据
|
|||
|
|
else:
|
|||
|
|
# AIS解调器 (4-5): 使用M.1371-5 Annex8 Message1格式
|
|||
|
|
content = self.generate_ais_message1()
|
|||
|
|
|
|||
|
|
return demod_data + content
|
|||
|
|
|
|||
|
|
def generate_ais_message1(self):
|
|||
|
|
"""生成AIS Message 1（位置报告）"""
|
|||
|
|
# 在长江入海口附近随机生成位置
|
|||
|
|
lat = YANGTZE_DELTA_CENTER[0] + random.uniform(-DELTA_RANGE, DELTA_RANGE)
|
|||
|
|
lon = YANGTZE_DELTA_CENTER[1] + random.uniform(-DELTA_RANGE, DELTA_RANGE)
|
|||
|
|
|
|||
|
|
# 转换为1/10000分钟格式
|
|||
|
|
lat_min = int(lat * 60 * 10000)
|
|||
|
|
lon_min = int(lon * 60 * 10000)
|
|||
|
|
|
|||
|
|
# 其他AIS字段
|
|||
|
|
message_id = 1
|
|||
|
|
repeat_indicator = 0
|
|||
|
|
navigational_status = random.randint(0, 15) # 航行状态
|
|||
|
|
rate_of_turn = random.randint(-128, 127) # 转向率
|
|||
|
|
speed_over_ground = random.randint(0, 1022) # 对地航速 (0.1节)
|
|||
|
|
position_accuracy = 1 # 高精度
|
|||
|
|
course_over_ground = random.randint(0, 3599) # 对地航向 (0.1度)
|
|||
|
|
true_heading = random.randint(0, 359) # 真航向
|
|||
|
|
timestamp = random.randint(0, 59) # UTC秒
|
|||
|
|
maneuver_indicator = random.randint(0, 1) # 操纵指示器
|
|||
|
|
spare = 0
|
|||
|
|
raim_flag = 0 # RAIM标志
|
|||
|
|
|
|||
|
|
# 打包AIS Message 1
|
|||
|
|
return struct.pack('>B', message_id) + \
|
|||
|
|
struct.pack('>B', (repeat_indicator << 6) | (navigational_status << 2) | (rate_of_turn >> 6)) + \
|
|||
|
|
struct.pack('>B', (rate_of_turn & 0x3F) << 2) | (speed_over_ground >> 8) + \
|
|||
|
|
struct.pack('>B', speed_over_ground & 0xFF) + \
|
|||
|
|
struct.pack('>B', (position_accuracy << 7) | (lon_min >> 25)) + \
|
|||
|
|
struct.pack('>B', (lon_min >> 17) & 0xFF) + \
|
|||
|
|
struct.pack('>B', (lon_min >> 9) & 0xFF) + \
|
|||
|
|
struct.pack('>B', (lon_min >> 1) & 0xFF) + \
|
|||
|
|
struct.pack('>B', ((lon_min & 0x1) << 7) | (lat_min >> 20)) + \
|
|||
|
|
struct.pack('>B', (lat_min >> 12) & 0xFF) + \
|
|||
|
|
struct.pack('>B', (lat_min >> 4) & 0xFF) + \
|
|||
|
|
struct.pack('>B', ((lat_min & 0xF) << 4) | (course_over_ground >> 8)) + \
|
|||
|
|
struct.pack('>B', course_over_ground & 0xFF) + \
|
|||
|
|
struct.pack('>H', true_heading) + \
|
|||
|
|
struct.pack('>B', timestamp) + \
|
|||
|
|
struct.pack('>B', (maneuver_indicator << 2) | spare) + \
|
|||
|
|
struct.pack('>B', raim_flag)
|
|||
|
|
|
|||
|
|
if __name__ == "__main__":
|
|||
|
|
server = VDESServer()
|
|||
|
|
try:
|
|||
|
|
server.start()
|
|||
|
|
except PermissionError:
|
|||
|
|
print("错误：需要管理员权限绑定到端口10")
|
|||
|
|
except KeyboardInterrupt:
|
|||
|
|
server.stop()
|