214 lines
7.2 KiB
Python
214 lines
7.2 KiB
Python
|
import struct
|
|||
|
|
import socket
|
|||
|
|
import time
|
|||
|
|
import random
|
|||
|
|
import math
|
|||
|
|
|
|||
|
|
class Ship:
|
|||
|
|
def __init__(self, mmsi, lat, lon, heading, speed=280.24):
|
|||
|
|
self.mmsi = mmsi
|
|||
|
|
self.lat = lat
|
|||
|
|
self.lon = lon
|
|||
|
|
self.heading = heading
|
|||
|
|
self.speed = speed # 加速100倍用于演示
|
|||
|
|
|
|||
|
|
def update_position(self):
|
|||
|
|
"""更新船只位置"""
|
|||
|
|
# 速度转换
|
|||
|
|
speed_kmh = self.speed * 1.852
|
|||
|
|
speed_kmps = speed_kmh / 3600
|
|||
|
|
distance_km = speed_kmps * 1
|
|||
|
|
|
|||
|
|
# 航向转弧度
|
|||
|
|
heading_rad = math.radians(self.heading)
|
|||
|
|
|
|||
|
|
# 计算经纬度变化
|
|||
|
|
delta_lat = distance_km / 111.0 * math.cos(heading_rad)
|
|||
|
|
delta_lon = distance_km / (111.0 * math.cos(math.radians(self.lat))) * math.sin(heading_rad)
|
|||
|
|
|
|||
|
|
# 更新位置
|
|||
|
|
self.lat += delta_lat
|
|||
|
|
self.lon += delta_lon
|
|||
|
|
|
|||
|
|
return self.lon, self.lat
|
|||
|
|
|
|||
|
|
class OwnShip(Ship):
|
|||
|
|
def __init__(self, lat, lon, heading, speed=280.24):
|
|||
|
|
super().__init__(336295999, lat, lon, heading, speed) # 使用固定MMSI作为本船
|
|||
|
|
|
|||
|
|
def get_position(self):
|
|||
|
|
"""获取本船位置并更新"""
|
|||
|
|
return self.update_position()
|
|||
|
|
|
|||
|
|
class VDESPacketCreator:
|
|||
|
|
@staticmethod
|
|||
|
|
def create_tcp_packet(packet_type, content):
|
|||
|
|
"""创建符合VDES TCP协议的报文"""
|
|||
|
|
header = b'####'
|
|||
|
|
type_field = struct.pack('>I', packet_type)
|
|||
|
|
length_field = struct.pack('>I', len(content))
|
|||
|
|
return header + type_field + length_field + content
|
|||
|
|
|
|||
|
|
@classmethod
|
|||
|
|
def create_gps_packet(cls, own_ship):
|
|||
|
|
"""创建GPS解析数据报文(类型7)的内容"""
|
|||
|
|
lon, lat = own_ship.get_position()
|
|||
|
|
|
|||
|
|
# 打包GPS数据
|
|||
|
|
return struct.pack(
|
|||
|
|
'>QiiiHHHBBIII',
|
|||
|
|
1680000000, # UTC时间
|
|||
|
|
int(lon * 10000000), # 经度
|
|||
|
|
int(lat * 10000000), # 纬度
|
|||
|
|
50, # 海拔高度
|
|||
|
|
10, # 定位使用的卫星数
|
|||
|
|
8, # GPS卫星数
|
|||
|
|
7, # 北斗卫星数
|
|||
|
|
1, # GPS状态
|
|||
|
|
3, # 定位模式
|
|||
|
|
2550, # 水平精度因子
|
|||
|
|
1024, # 运动速度
|
|||
|
|
own_ship.heading # 运动方向
|
|||
|
|
)
|
|||
|
|
|
|||
|
|
@classmethod
|
|||
|
|
def create_ais_info_packet(cls, ship):
|
|||
|
|
"""创建解调信息报文(类型12)的内容"""
|
|||
|
|
demod_content = cls.encode_demod_fields(ship)
|
|||
|
|
|
|||
|
|
# 打包解调信息
|
|||
|
|
message_type = 12
|
|||
|
|
satellite_id = 1
|
|||
|
|
demodulator_id = 0
|
|||
|
|
demod_slot = 1234
|
|||
|
|
receive_delay = 5678
|
|||
|
|
snr = 25.75
|
|||
|
|
|
|||
|
|
# 处理信噪比
|
|||
|
|
snr_int = int(snr)
|
|||
|
|
snr_frac = int((snr - snr_int) * 100)
|
|||
|
|
snr_packed = (snr_int & 0xFF) << 8 | (snr_frac & 0xFF)
|
|||
|
|
|
|||
|
|
header = struct.pack(
|
|||
|
|
'>BBBHHH',
|
|||
|
|
message_type,
|
|||
|
|
satellite_id,
|
|||
|
|
demodulator_id,
|
|||
|
|
demod_slot,
|
|||
|
|
receive_delay,
|
|||
|
|
snr_packed
|
|||
|
|
)
|
|||
|
|
return header + demod_content
|
|||
|
|
|
|||
|
|
@staticmethod
|
|||
|
|
def encode_demod_fields(ship):
|
|||
|
|
"""编码解调信息字段"""
|
|||
|
|
lon, lat = ship.update_position()
|
|||
|
|
|
|||
|
|
# 准备数据
|
|||
|
|
message_id = 1
|
|||
|
|
repeat_indicator = 0
|
|||
|
|
user_id = ship.mmsi
|
|||
|
|
navigation_status = 8
|
|||
|
|
rot = -128
|
|||
|
|
sog = 102
|
|||
|
|
position_accuracy = 1
|
|||
|
|
cog = ship.heading
|
|||
|
|
true_heading = ship.heading
|
|||
|
|
timestamp = 30
|
|||
|
|
special_maneuver = 0
|
|||
|
|
spare = 0
|
|||
|
|
raim_flag = 0
|
|||
|
|
comm_state = 0
|
|||
|
|
|
|||
|
|
# 转换为协议要求的格式
|
|||
|
|
longitude_min = int(lon * 60 * 10000)
|
|||
|
|
latitude_min = int(lat * 60 * 10000)
|
|||
|
|
|
|||
|
|
# 构建二进制位
|
|||
|
|
bits = [
|
|||
|
|
format(message_id, '06b'),
|
|||
|
|
format(repeat_indicator, '02b'),
|
|||
|
|
format(user_id, '030b'),
|
|||
|
|
format(navigation_status, '04b'),
|
|||
|
|
format(rot & 0xFF, '08b'),
|
|||
|
|
format(min(sog, 1023), '010b'),
|
|||
|
|
str(position_accuracy),
|
|||
|
|
format(longitude_min & 0x0FFFFFFF, '028b'),
|
|||
|
|
format(latitude_min & 0x07FFFFFF, '027b'),
|
|||
|
|
format(min(cog, 3600), '012b'),
|
|||
|
|
format(min(true_heading, 511), '09b'),
|
|||
|
|
format(min(timestamp, 63), '06b'),
|
|||
|
|
format(special_maneuver, '02b'),
|
|||
|
|
format(spare, '03b'),
|
|||
|
|
str(raim_flag),
|
|||
|
|
format(comm_state, '019b')
|
|||
|
|
]
|
|||
|
|
|
|||
|
|
# 合并所有位并转换为字节
|
|||
|
|
bit_string = ''.join(bits)
|
|||
|
|
binary_int = int(bit_string, 2)
|
|||
|
|
byte_length = (len(bit_string) + 7) // 8
|
|||
|
|
return binary_int.to_bytes(byte_length, 'big')
|
|||
|
|
|
|||
|
|
class VDEServer:
|
|||
|
|
def __init__(self, host='127.0.0.1', port=10):
|
|||
|
|
self.host = host
|
|||
|
|
self.port = port
|
|||
|
|
self.own_ship = OwnShip(31.23, 123.87, 90)
|
|||
|
|
self.ships = self.create_ships(30)
|
|||
|
|
|
|||
|
|
@staticmethod
|
|||
|
|
def create_ships(count):
|
|||
|
|
"""创建指定数量的船只"""
|
|||
|
|
return [
|
|||
|
|
Ship(
|
|||
|
|
mmsi=336295939 + i,
|
|||
|
|
lat=round(random.uniform(30.0, 34.0), 6),
|
|||
|
|
lon=round(random.uniform(123.5, 126.0), 6),
|
|||
|
|
heading=random.randint(0, 359)
|
|||
|
|
) for i in range(count)
|
|||
|
|
]
|
|||
|
|
|
|||
|
|
def send_data_continuously(self):
|
|||
|
|
"""启动Socket服务端并持续发送数据"""
|
|||
|
|
with socket.socket(socket.AF_INET, socket.SOCK_STREAM) as s:
|
|||
|
|
s.setsockopt(socket.SOL_SOCKET, socket.SO_REUSEADDR, 1)
|
|||
|
|
s.bind((self.host, self.port))
|
|||
|
|
s.listen(1)
|
|||
|
|
print(f"Socket服务端已启动，监听 {self.host}:{self.port}")
|
|||
|
|
|
|||
|
|
while True:
|
|||
|
|
try:
|
|||
|
|
conn, addr = s.accept()
|
|||
|
|
print(f"客户端连接来自: {addr}")
|
|||
|
|
|
|||
|
|
while True:
|
|||
|
|
try:
|
|||
|
|
# 随机选择一艘船发送AIS报文
|
|||
|
|
selected_ship = random.choice(self.ships)
|
|||
|
|
ais_data = VDESPacketCreator.create_ais_info_packet(selected_ship)
|
|||
|
|
ais_packet = VDESPacketCreator.create_tcp_packet(12, ais_data)
|
|||
|
|
conn.sendall(ais_packet)
|
|||
|
|
|
|||
|
|
# 发送本船GPS报文
|
|||
|
|
gps_content = VDESPacketCreator.create_gps_packet(self.own_ship)
|
|||
|
|
gps_packet = VDESPacketCreator.create_tcp_packet(7, gps_content)
|
|||
|
|
conn.sendall(gps_packet)
|
|||
|
|
|
|||
|
|
time.sleep(0.5)
|
|||
|
|
|
|||
|
|
except (ConnectionResetError, BrokenPipeError):
|
|||
|
|
print("客户端断开连接")
|
|||
|
|
break
|
|||
|
|
|
|||
|
|
except KeyboardInterrupt:
|
|||
|
|
print("\n服务端已停止")
|
|||
|
|
break
|
|||
|
|
except Exception as e:
|
|||
|
|
print(f"服务端错误: {e}")
|
|||
|
|
break
|
|||
|
|
|
|||
|
|
if __name__ == "__main__":
|
|||
|
|
server = VDEServer()
|
|||
|
|
server.send_data_continuously()
|