244 lines
11 KiB
Python
244 lines
11 KiB
Python
import struct
|
||
from typing import Optional
|
||
from converter.base_converter import BaseConverter
|
||
from utils.logger import logger
|
||
from utils.hex_helper import hex_dump
|
||
|
||
# ====================== 指令映射表 ======================
|
||
CMD_MAP = {
|
||
"5555000811110010A5A5A5A5A5A5A5A5A5": "K3008",
|
||
"5555000911110010A5A5A5A5A5A5A5A5A5": "K3009",
|
||
"5555000A11110010A5A5A5A5A5A5A5A5A5": "K3010",
|
||
"5555000B11110010A5A5A5A5A5A5A5A5A5": "K3011",
|
||
"88880A0506040004000400A5A5A5A5A5A5": "K6307",
|
||
"88880A0506040104010401A5A5A5A5A5A5": "K6308",
|
||
"88880A0506040204020402A5A5A5A5A5A5": "K6309",
|
||
"88880A0506040304030403A5A5A5A5A5A5": "K6310",
|
||
"88880A0506040404040404A5A5A5A5A5A5": "K6311",
|
||
"88880A0506040504050405A5A5A5A5A5A5": "K6312",
|
||
"88880A0506040604060406A5A5A5A5A5A5": "K6313",
|
||
"88880A0506040704070407A5A5A5A5A5A5": "K6314",
|
||
"88880A0506040804080408A5A5A5A5A5A5": "K6315",
|
||
"88880A0506040904090409A5A5A5A5A5A5": "K6316",
|
||
"88880A0506040A040A040AA5A5A5A5A5A5": "K6317",
|
||
"88880A0506040B040B040BA5A5A5A5A5A5": "K6318",
|
||
"88880A0506040C040C040CA5A5A5A5A5A5": "K6319",
|
||
"88880A0506040D040D040DA5A5A5A5A5A5": "K6320",
|
||
"88880A0506040E040E040EA5A5A5A5A5A5": "K6321",
|
||
"88880A0506040F040F040FA5A5A5A5A5A5": "K6322",
|
||
"88880A0506050005000500A5A5A5A5A5A5": "K6323",
|
||
"88880A0506050105010501A5A5A5A5A5A5": "K6324",
|
||
"88880A0506050205020502A5A5A5A5A5A5": "K6325",
|
||
"88880A0506050305030503A5A5A5A5A5A5": "K6326",
|
||
"88880A0506050405040504A5A5A5A5A5A5": "K6327",
|
||
"88880A0506050505050505A5A5A5A5A5A5": "K6328",
|
||
"88880A0506050605060506A5A5A5A5A5A5": "K6329",
|
||
"88880A0506050705070507A5A5A5A5A5A5": "K6330",
|
||
"88880A0506050805080508A5A5A5A5A5A5": "K6331",
|
||
"88880A0506050905090509A5A5A5A5A5A5": "K6332",
|
||
"88880A0506050A050A050AA5A5A5A5A5A5": "K6333",
|
||
"88880A0506050B050B050BA5A5A5A5A5A5": "K6334",
|
||
"88880A0506050C050C050CA5A5A5A5A5A5": "K6335",
|
||
"88880A0506050D050D050DA5A5A5A5A5A5": "K6336",
|
||
"88880A0506050E050E050EA5A5A5A5A5A5": "K6337",
|
||
"88880A0506050F050F050FA5A5A5A5A5A5": "K6338",
|
||
"88880A0506060006000600A5A5A5A5A5A5": "K6339",
|
||
"88880A0506060106010601A5A5A5A5A5A5": "K6340",
|
||
"88880A0506060206020602A5A5A5A5A5A5": "K6341",
|
||
"88880A0506060306030603A5A5A5A5A5A5": "K6342",
|
||
"88880A0506060406040604A5A5A5A5A5A5": "K6343",
|
||
"88880A0506060506050605A5A5A5A5A5A5": "K6344",
|
||
"88880A0506060606060606A5A5A5A5A5A5": "K6345",
|
||
"88880A0506060706070607A5A5A5A5A5A5": "K6346",
|
||
"88880A0506060806080608A5A5A5A5A5A5": "K6347",
|
||
"88880A0506060906090609A5A5A5A5A5A5": "K6348",
|
||
"88880A0506060A060A060AA5A5A5A5A5A5": "K6349",
|
||
"88880A0506060B060B060BA5A5A5A5A5A5": "K6350",
|
||
"88880A0506060C060C060CA5A5A5A5A5A5": "K6351",
|
||
"88880A0506060D060D060DA5A5A5A5A5A5": "K6352",
|
||
"88880A0506060E060E060EA5A5A5A5A5A5": "K6353",
|
||
"88880A0506060F060F060FA5A5A5A5A5A5": "K6354",
|
||
"88880A0506070007000700A5A5A5A5A5A5": "K6355",
|
||
"88880A0506070107010701A5A5A5A5A5A5": "K6356",
|
||
"88880A0506070207020702A5A5A5A5A5A5": "K6357",
|
||
"88880A0506070307030703A5A5A5A5A5A5": "K6358",
|
||
"88880A0506070407040704A5A5A5A5A5A5": "K6359",
|
||
"88880A0506070507050705A5A5A5A5A5A5": "K6360",
|
||
"88880A0506070607060706A5A5A5A5A5A5": "K6361",
|
||
"88880A0506070707070707A5A5A5A5A5A5": "K6362",
|
||
"88880A0506070807080708A5A5A5A5A5A5": "K6363",
|
||
"88880A0506070907090709A5A5A5A5A5A5": "K6364",
|
||
"88880A0506070A070A070AA5A5A5A5A5A5": "K6365",
|
||
"88880A0506070B070B070BA5A5A5A5A5A5": "K6366",
|
||
"88880A0506070C070C070CA5A5A5A5A5A5": "K6367",
|
||
"88880A0506070D070D070DA5A5A5A5A5A5": "K6368",
|
||
"88880A0506070E070E070EA5A5A5A5A5A5": "K6369",
|
||
"88880A0506070F070F070FA5A5A5A5A5A5": "K6370",
|
||
"88880101061111001B0000A5A5A5A5A5A5": "K6155",
|
||
"88880101061111001C0000A5A5A5A5A5A5": "K6156",
|
||
"88880101061111001F0000A5A5A5A5A5A5": "K6159",
|
||
"8888010106111100200000A5A5A5A5A5A5": "K6160",
|
||
"8888010106111100620000A5A5A5A5A5A5": "K6225",
|
||
"8888010106111100630000A5A5A5A5A5A5": "K6226",
|
||
"8888010106111100210000A5A5A5A5A5A5": "K6161",
|
||
"8888010106111100220000A5A5A5A5A5A5": "K6162",
|
||
"8888010106111100270000A5A5A5A5A5A5": "K6166",
|
||
"8888010106111100280000A5A5A5A5A5A5": "K6167",
|
||
"8888010106111100330000A5A5A5A5A5A5": "K6178",
|
||
"8888010106111100340000A5A5A5A5A5A5": "K6179",
|
||
"8888010106111100350000A5A5A5A5A5A5": "K6180",
|
||
"8888010106111100360000A5A5A5A5A5A5": "K6181",
|
||
"88880101061111006A0000A5A5A5A5A5A5": "K6233",
|
||
"88880101061111006B0000A5A5A5A5A5A5": "K6234",
|
||
"88880101061111007E0000A5A5A5A5A5A5": "K6253",
|
||
"88880101061111007F0000A5A5A5A5A5A5": "K6254",
|
||
"88880C1B0C020222BBAAAAAAAAAAAAAA33": "K6557",
|
||
"88880C1B0C020222CCAAAAAAAAAAAAAA44": "K6558",
|
||
"88880101061111003D0000A5A5A5A5A5A5": "K6188",
|
||
"88880101061111003E0000A5A5A5A5A5A5": "K6189",
|
||
"88880101061111003F0000A5A5A5A5A5A5": "K6190",
|
||
"8888010106111100400000A5A5A5A5A5A5": "K6191",
|
||
"8888010106111100410000A5A5A5A5A5A5": "K6192",
|
||
"8888010106111100420000A5A5A5A5A5A5": "K6193",
|
||
"8888010106111100430000A5A5A5A5A5A5": "K6194",
|
||
"8888010106111100440000A5A5A5A5A5A5": "K6195",
|
||
"88880C1B0C02021177AAAAAAAAAAAAAACC": "K6451",
|
||
"88880C1B0C02021188AAAAAAAAAAAAAA33": "K6452",
|
||
"88880101061111000B0000A5A5A5A5A5A5": "K6139",
|
||
"88880101061111000C0000A5A5A5A5A5A5": "K6140",
|
||
"8888010106111100170000A5A5A5A5A5A5": "K6151",
|
||
"8888010106111100180000A5A5A5A5A5A5": "K6152",
|
||
"8888010106111100610000A5A5A5A5A5A5": "K6224",
|
||
"8888010106111100780000A5A5A5A5A5A5": "K6247",
|
||
"8888010106111100790000A5A5A5A5A5A5": "K6248",
|
||
#2026/4/13新增
|
||
"888810010AA0A00000000000000000A5A5":"K6669",
|
||
"888810010A40500000000000000000A5A5":"K6670",
|
||
"888810010A50400000000000000000A5A5":"K6671",
|
||
"888810010A6070AB180000AB180000A5A5":"K6672",
|
||
"888810010A7060AB180000AB180000A5A5":"K6673",
|
||
"888810010A00000000000000000000A5A5":"K6674",
|
||
"888810010A20300000000000000000A5A5":"K6675",
|
||
"888810010A30200000000000000000A5A5":"K6676",
|
||
#2026/4/16新增
|
||
"888810010A00300000000000000000A5A5":"K6677",
|
||
"888810010A00200000000000000000A5A5":"K6678",
|
||
"888810010A00500000000000000000A5A5":"K6679",
|
||
"888810010A00400000000000000000A5A5":"K6680",
|
||
"888810010A007000000000AB180000A5A5":"K6681",
|
||
"888810010A006000000000AB180000A5A5":"K6682",
|
||
"888810010A00A00000000000000000A5A5":"K6683",
|
||
"888810010A20000000000000000000A5A5":"K6684",
|
||
"888810010A30000000000000000000A5A5":"K6685",
|
||
"888810010A20500000000000000000A5A5":"K6686",
|
||
"888810010A30400000000000000000A5A5":"K6687",
|
||
"888810010A207000000000AB180000A5A5":"K6688",
|
||
"888810010A306000000000AB180000A5A5":"K6689",
|
||
"888810010A20A00000000000000000A5A5":"K6690",
|
||
"888810010A30A00000000000000000A5A5":"K6691",
|
||
"888810010A40000000000000000000A5A5":"K6692",
|
||
"888810010A50000000000000000000A5A5":"K6693",
|
||
"888810010A40300000000000000000A5A5":"K6694",
|
||
"888810010A50200000000000000000A5A5":"K6695",
|
||
"888810010A407000000000AB180000A5A5":"K6696",
|
||
"888810010A506000000000AB180000A5A5":"K6697",
|
||
"888810010A40A00000000000000000A5A5":"K6698",
|
||
"888810010A50A00000000000000000A5A5":"K6699",
|
||
"888810010A6000AB18000000000000A5A5":"K6700",
|
||
"888810010A7000AB18000000000000A5A5":"K6701",
|
||
"888810010A6030AB18000000000000A5A5":"K6702",
|
||
"888810010A7020AB18000000000000A5A5":"K6703",
|
||
"888810010A6050AB18000000000000A5A5":"K6704",
|
||
"888810010A7040AB18000000000000A5A5":"K6705",
|
||
"888810010A60A0AB18000000000000A5A5":"K6706",
|
||
"888810010A70A0AB18000000000000A5A5":"K6707",
|
||
"888810010AA0000000000000000000A5A5":"K6708",
|
||
"888810010AA0300000000000000000A5A5":"K6709",
|
||
"888810010AA0200000000000000000A5A5":"K6710",
|
||
"888810010AA0500000000000000000A5A5":"K6711",
|
||
"888810010AA0400000000000000000A5A5":"K6712",
|
||
"888810010AA07000000000AB180000A5A5":"K6713",
|
||
"888810010AA06000000000AB180000A5A5":"K6714",
|
||
"888810010A40400000000000000000A5A5":"K6715",
|
||
"888810010A50500000000000000000A5A5":"K6716",
|
||
"888810010A6060AB180000AB180000A5A5":"K6717",
|
||
"888810010A7070AB180000AB180000A5A5":"K6718",
|
||
"888810010A20200000000000000000A5A5":"K6719",
|
||
"888810010A30300000000000000000A5A5":"K6720",
|
||
"888810010A20400000000000000000A5A5":"K6723",
|
||
"888810010A30500000000000000000A5A5":"K6724",
|
||
"888810010A206000000000AB180000A5A5":"K6725",
|
||
"888810010A307000000000AB180000A5A5":"K6726",
|
||
"888810010A40200000000000000000A5A5":"K6727",
|
||
"888810010A50300000000000000000A5A5":"K6728",
|
||
"888810010A406000000000AB180000A5A5":"K6729",
|
||
"888810010A507000000000AB180000A5A5":"K6730",
|
||
"888810010A6020AB18000000000000A5A5":"K6731",
|
||
"888810010A7030AB18000000000000A5A5":"K6732",
|
||
"888810010A6040AB18000000000000A5A5":"K6733",
|
||
"888810010A7050AB18000000000000A5A5":"K6734",
|
||
"BBBBFF0101A5A5A5A5A5A5A5A5A5A5A5A5":"K1085",
|
||
"BBBBFF0202A5A5A5A5A5A5A5A5A5A5A5A5":"K1089",
|
||
|
||
|
||
}
|
||
|
||
class C2AConverter(BaseConverter):
|
||
def convert(self, data: bytes) -> Optional[bytes]:
|
||
try:
|
||
# ========= 1. 截取指令码（B48~B64） =========
|
||
if len(data) < 65:
|
||
logger.warning("帧长度不足，无法解析指令")
|
||
return None
|
||
|
||
# cmd_bytes = data[48:48+17]#遥控通道遥控帧
|
||
cmd_bytes = data[54:(54+17)]#地测通道遥控帧
|
||
cmd_hex = cmd_bytes.hex().upper()
|
||
#logger.info(f"🔍 提取指令码：{cmd_hex}")
|
||
|
||
# ========= 2. 查询指令是否需要转发 =========
|
||
if cmd_hex not in CMD_MAP:
|
||
#logger.info("ℹ️ 指令不在转发列表，不发送给 A")
|
||
return None
|
||
|
||
cmd_code = CMD_MAP[cmd_hex]
|
||
logger.info(f"✅ 匹配指令：{cmd_code}，准备转发给 A")
|
||
|
||
# ========= 3. 提取数字（4位十进制） =========
|
||
num_str = cmd_code[1:] # K3008 → 3008
|
||
num = int(num_str)
|
||
logger.info(f"✅ 匹配指令：{cmd_code}，🔢 指令编号：{num_str} → {num}")
|
||
|
||
# ========= 4. 转 double（8字节 大端） =========
|
||
double_big = struct.pack('>d', float(num))
|
||
|
||
# ========= 5. 组 A 软件协议帧 =========
|
||
HEADER = 0xEB90EB90
|
||
DATA_LEN = 0x08
|
||
if num == 1085 or num == 1089:
|
||
DIR = 0x02222222 #控制前端到同元
|
||
DATA_ID = 0x00330000 #测控
|
||
else:
|
||
DIR = 0x01111111 #0x02222222改为0x01111111(数字卫星到同元)
|
||
DATA_ID = 0x00440000 #SADA
|
||
PARAM_TYPE = 0x00222222
|
||
SATELLITE = 0x00000001
|
||
TAIL = 0x4C3A
|
||
|
||
frame = (
|
||
struct.pack('>I', HEADER)
|
||
+ struct.pack('>I', DATA_LEN)
|
||
+ struct.pack('>I', DIR)
|
||
+ struct.pack('>I', DATA_ID)
|
||
+ struct.pack('>I', PARAM_TYPE)
|
||
+ struct.pack('>I', SATELLITE)
|
||
+ double_big
|
||
+ struct.pack('>H', TAIL)
|
||
)
|
||
|
||
hex_dump(frame, f"向A 软件发送帧 [{cmd_code}]")
|
||
return frame
|
||
|
||
except Exception as e:
|
||
logger.error(f"C→A 转换失败：{e}", exc_info=True)
|
||
return None |