SOME/IP:用Python实现协议订阅、Offer、订阅ACK与报文接收

文章目录

  • 前言
  • 一、代码层次
  • 二、详细代码
    • 1. eth_scapy_sd.py
    • 2、eth_scapy_someip.py
    • 3、network_define.py
    • 4、packet_define.py
    • 5、unpack_define.py
    • 6、someip_controller.py


前言

1、需要pip安装scapy库
2、需要修改根据实际情况配置network_define.py
3、执行someip_controller.py运行本案例
4、本文参考github: eth-scapy-someip

注:最近没啥时间写文章,有兴趣自己研究下<~~>


一、代码层次

someip/
└── module/├── eth_scapy_sd.py          # SOME/IP SD服务发现结构体定义├── eth_scapy_someip.py      # SOME/IP标准结构体定义├── network_define.py        # 网络配置(IP/端口/多播组)├── packet_define.py         # 协议字段定义(Offer/Subscribe/ACK)├── unpack_define.py         # 接收报文解析器└── someip_controller.py     # 主控制逻辑(订阅/OFFER/ACK流程管理)

二、详细代码

1. eth_scapy_sd.py

import ctypes
import collectionsfrom eth_scapy_someip import SOMEIPfrom scapy.fields import *
from scapy.packet import *
from scapy.layers.inet6 import IP6Fieldclass _SDPacketBase(Packet):"""base class to be used among all SD Packet definitions."""# use this dictionary to set default values for desired fields (mostly on subclasses# where not all fields are defined locally)# - key : field_name, value : desired value# - it will be used from 'init_fields' function, upon packet initialization## example : _defaults = {'field_1_name':field_1_value,'field_2_name':field_2_value}_defaults = {}def _set_defaults(self):"""goes through '_defaults' dict setting field default values (for those that have been defined)."""for key in self._defaults.keys():try:self.get_field(key)except KeyError:passelse:self.setfieldval(key, self._defaults[key])def init_fields(self):"""perform initialization of packet fields with desired values.NOTE : this funtion will only be called *once* upon class (or subclass) construction"""Packet.init_fields(self)self._set_defaults()# SD ENTRY
#  - Service
#  - EventGroup
class _SDEntry(_SDPacketBase):"""Base class for SDEntry_* packages."""TYPE_FMT = ">B"TYPE_PAYLOAD_I = 0# ENTRY TYPES : SERVICETYPE_SRV_FINDSERVICE = 0x00TYPE_SRV_OFFERSERVICE = 0x01TYPE_SRV = (TYPE_SRV_FINDSERVICE, TYPE_SRV_OFFERSERVICE)# ENTRY TYPES : EVENGROUPTYPE_EVTGRP_SUBSCRIBE = 0x06TYPE_EVTGRP_SUBSCRIBE_ACK = 0x07TYPE_EVTGRP = (TYPE_EVTGRP_SUBSCRIBE, TYPE_EVTGRP_SUBSCRIBE_ACK)# overall len (UT usage)OVERALL_LEN = 16# 定义Entries Array结构体fields_desc = [ByteField("type", 0),ByteField("index_1", 0),ByteField("index_2", 0),BitField("n_opt_1", 0, 4),BitField("n_opt_2", 0, 4),ShortField("srv_id", 0),ShortField("inst_id", 0),ByteField("major_ver", 0),X3BytesField("ttl", 0),]def guess_payload_class(self, payload):"""decode SDEntry depending on its type."""pl_type = struct.unpack(_SDEntry.TYPE_FMT,payload[_SDEntry.TYPE_PAYLOAD_I : _SDEntry.TYPE_PAYLOAD_I + 1],)[0]if pl_type in _SDEntry.TYPE_SRV:return SDEntry_Serviceelif pl_type in _SDEntry.TYPE_EVTGRP:return SDEntry_EventGroupclass SDEntry_Service(_SDEntry):"""Service Entry."""_defaults = {"type": _SDEntry.TYPE_SRV_FINDSERVICE}name = "Service Entry"fields_desc = [_SDEntry, IntField("minor_ver", 0)]class SDEntry_EventGroup(_SDEntry):"""EventGroup Entry."""_defaults = {"type": _SDEntry.TYPE_EVTGRP_SUBSCRIBE}name = "Eventgroup Entry"fields_desc = [_SDEntry,BitField("res", 0, 12),BitField("cnt", 0, 4),ShortField("eventgroup_id", 0),]# SD Option
#  - Configuration
#  - LoadBalancing
#  - IPv4 EndPoint
#  - IPv6 EndPoint
#  - IPv4 MultiCast
#  - IPv6 MultiCast
#  - IPv4 EndPoint
#  - IPv6 EndPoint
class _SDOption(_SDPacketBase):"""Base class for SDOption_* packages."""TYPE_FMT = ">B"TYPE_PAYLOAD_I = 2CFG_TYPE = 0x01CFG_OVERALL_LEN = (4  # overall length of CFG SDOption,empty 'cfg_str' (to be used from UT))LOADBALANCE_TYPE = 0x02LOADBALANCE_LEN = 0x05LOADBALANCE_OVERALL_LEN = 8  # overall length of LB SDOption (to be used from UT)IP4_ENDPOINT_TYPE = 0x04IP4_ENDPOINT_LEN = 0x0009IP4_MCAST_TYPE = 0x14IP4_MCAST_LEN = 0x0009IP4_SDENDPOINT_TYPE = 0x24IP4_SDENDPOINT_LEN = 0x0009IP4_OVERALL_LEN = 12  # overall length of IP4 SDOption (to be used from UT)IP6_ENDPOINT_TYPE = 0x06IP6_ENDPOINT_LEN = 0x0015IP6_MCAST_TYPE = 0x16IP6_MCAST_LEN = 0x0015IP6_SDENDPOINT_TYPE = 0x26IP6_SDENDPOINT_LEN = 0x0015IP6_OVERALL_LEN = 24  # overall length of IP6 SDOption (to be used from UT)def guess_payload_class(self, payload):"""decode SDOption depending on its type."""pl_type = struct.unpack(_SDOption.TYPE_FMT,payload[_SDOption.TYPE_PAYLOAD_I : _SDOption.TYPE_PAYLOAD_I + 1],)[0]if pl_type == _SDOption.CFG_TYPE:return SDOption_Configelif pl_type == self.LOADBALANCE_TYPE:return SDOption_LoadBalanceelif pl_type == self.IP4_ENDPOINT_TYPE:return SDOption_IP4_EndPointelif pl_type == self.IP4_MCAST_TYPE:return SDOption_IP4_Multicastelif pl_type == self.IP4_SDENDPOINT_TYPE:return SDOption_IP4_SD_EndPointelif pl_type == self.IP6_ENDPOINT_TYPE:return SDOption_IP6_EndPointelif pl_type == self.IP6_MCAST_TYPE:return SDOption_IP6_Multicastelif pl_type == self.IP6_SDENDPOINT_TYPE:return SDOption_IP6_SD_EndPointclass _SDOption_Header(_SDOption):fields_desc = [ShortField("len", None),ByteField("type", 0),ByteField("res_hdr", 0),]class _SDOption_Tail(_SDOption):fields_desc = [ByteField("res_tail", 0),ByteEnumField("l4_proto", 0x06, {0x06: "TCP", 0x11: "UDP"}),ShortField("port", 0),]class _SDOption_IP4(_SDOption):fields_desc = [_SDOption_Header, IPField("addr", "0.0.0.0"), _SDOption_Tail]class _SDOption_IP6(_SDOption):fields_desc = [_SDOption_Header,IP6Field("addr", "2001:cdba:0000:0000:0000:0000:3257:9652"),_SDOption_Tail,]class SDOption_Config(_SDOption):# offset to be added upon length calculation (corresponding to header's "Reserved" field)LEN_OFFSET = 0x01name = "Config Option"# default values specification_defaults = {"type": _SDOption.CFG_TYPE}# package fields definitonfields_desc = [_SDOption_Header, StrField("cfg_str", "")]def post_build(self, p, pay):# length computation excluding 16b_length and 8b_typel = self.lenif l is None:l = len(self.cfg_str) + self.LEN_OFFSETp = struct.pack("!H", l) + p[2:]return p + payclass SDOption_LoadBalance(_SDOption):name = "LoadBalance Option"# default values specification_defaults = {"type": _SDOption.LOADBALANCE_TYPE, "len": _SDOption.LOADBALANCE_LEN}# package fields definitonfields_desc = [_SDOption_Header, ShortField("priority", 0), ShortField("weight", 0)]# SDOPTIONS : IPv4-specific
class SDOption_IP4_EndPoint(_SDOption_IP4):name = "IP4 EndPoint Option"# default values specification_defaults = {"type": _SDOption.IP4_ENDPOINT_TYPE, "len": _SDOption.IP4_ENDPOINT_LEN}class SDOption_IP4_Multicast(_SDOption_IP4):name = "IP4 Multicast Option"# default values specification_defaults = {"type": _SDOption.IP4_MCAST_TYPE, "len": _SDOption.IP4_MCAST_LEN}class SDOption_IP4_SD_EndPoint(_SDOption_IP4):name = "IP4 SDEndPoint Option"# default values specification_defaults = {"type": _SDOption.IP4_SDENDPOINT_TYPE,"len": _SDOption.IP4_SDENDPOINT_LEN,}# SDOPTIONS : IPv6-specific
class SDOption_IP6_EndPoint(_SDOption_IP6):name = "IP6 EndPoint Option"# default values specification_defaults = {"type": _SDOption.IP6_ENDPOINT_TYPE, "len": _SDOption.IP6_ENDPOINT_LEN}class SDOption_IP6_Multicast(_SDOption_IP6):name = "IP6 Multicast Option"# default values specification_defaults = {"type": _SDOption.IP6_MCAST_TYPE, "len": _SDOption.IP6_MCAST_LEN}class SDOption_IP6_SD_EndPoint(_SDOption_IP6):name = "IP6 SDEndPoint Option"# default values specification_defaults = {"type": _SDOption.IP6_SDENDPOINT_TYPE,"len": _SDOption.IP6_SDENDPOINT_LEN,}#
# SD PACKAGE DEFINITION
#
class SD(_SDPacketBase):"""SD PacketNOTE :   when adding 'entries' or 'options', do not use list.append() method but create a new liste.g. :  p = SD()p.option_array = [SDOption_Config(),SDOption_IP6_EndPoint()]"""SOMEIP_MSGID_SRVID = 0xFFFFSOMEIP_MSGID_SUBID = 0x1SOMEIP_MSGID_EVENTID = 0x100SOMEIP_PROTO_VER = 0x01SOMEIP_IFACE_VER = 0x01SOMEIP_MSG_TYPE = SOMEIP.TYPE_NOTIFICATIONname = "SD"# Flags definition: {"name":(mask,offset)}_sdFlag = collections.namedtuple("Flag", "mask offset")FLAGSDEF = {"REBOOT": _sdFlag(mask=0x80, offset=7),  # ReBoot flag"UNICAST": _sdFlag(mask=0x40, offset=6),  # UniCast flag}fields_desc = [ByteField("flags", 0),X3BytesField("res", 0),FieldLenField(name="len_entry_array", default=None, length_of="entry_array", fmt="!I"),PacketListField(name="entry_array",default=None,pkt_cls=_SDEntry,length_from=lambda pkt: pkt.len_entry_array,),FieldLenField(name="len_option_array", default=None, length_of="option_array", fmt="!I"),PacketListField(name="option_array",default=None,pkt_cls=_SDOption,length_from=lambda pkt: pkt.len_option_array,),]def __init__(self, *args, **kwargs):super(SD, self).__init__(*args, **kwargs)self.explicit = 1def getFlag(self, name):"""get particular flag from bitfield."""name = name.upper()if name in self.FLAGSDEF:return (self.flags & self.FLAGSDEF[name].mask) >> self.FLAGSDEF[name].offsetelse:return Nonedef setFlag(self, name, value):"""Set particular flag on bitfield.:param str name : name of the flag to set (see SD.FLAGSDEF):param int value : either 0x1 or 0x0 (provided int will be ANDed with 0x01)"""name = name.upper()if name in self.FLAGSDEF:self.flags = (self.flags & ctypes.c_ubyte(~self.FLAGSDEF[name].mask).value) | (value & 0x01) << self.FLAGSDEF[name].offsetdef setEntryArray(self, entry_list):"""Add entries to entry_array.:param entry_list: list of entries to be added. Single entry object also accepted"""if isinstance(entry_list, list):self.entry_array = entry_listelse:self.entry_array = [entry_list]def setOptionArray(self, option_list):"""Add options to option_array.:param option_list: list of options to be added. Single option object also accepted"""if isinstance(option_list, list):self.option_array = option_listelse:self.option_array = [option_list]def getSomeip(self, stacked=False):"""return SD-initialized SOME/IP packet:param stacked: boolean. Either just SOME/IP packet or stacked over SD-self"""p = SOMEIP()p.msg_id.srv_id = SD.SOMEIP_MSGID_SRVIDp.msg_id.sub_id = SD.SOMEIP_MSGID_SUBIDp.msg_id.event_id = SD.SOMEIP_MSGID_EVENTIDp.proto_ver = SD.SOMEIP_PROTO_VERp.iface_ver = SD.SOMEIP_IFACE_VERp.msg_type = SD.SOMEIP_MSG_TYPEif stacked:return p / selfelse:return pdef get_someip_with_session_id(self,session_id, stacked=False):p = SOMEIP()p.msg_id.srv_id = SD.SOMEIP_MSGID_SRVIDp.msg_id.sub_id = SD.SOMEIP_MSGID_SUBIDp.msg_id.event_id = SD.SOMEIP_MSGID_EVENTIDp.proto_ver = SD.SOMEIP_PROTO_VERp.iface_ver = SD.SOMEIP_IFACE_VERp.msg_type = SD.SOMEIP_MSG_TYPEp.req_id.session_id = session_idif stacked:return p / selfelse:return p

2、eth_scapy_someip.py

from scapy.layers.inet import *
from scapy.fields import *
from scapy.packet import *"""SOMEIP PACKAGE DEFINITION"""class _SOMEIP_MessageId(Packet):"""MessageId subpacket."""name = 'MessageId'fields_desc = [ShortField('srv_id', 0),BitEnumField('sub_id', 0, 1, {0: 'METHOD_ID', 1: 'EVENT_ID'}),ConditionalField(BitField('method_id', 0, 15), lambda pkt: pkt.sub_id == 0),ConditionalField(BitField('event_id', 0, 15), lambda pkt: pkt.sub_id == 1)]def extract_padding(self, p):return '', pclass _SOMEIP_RequestId(Packet):""" RequestId subpacket."""name = 'RequestId'fields_desc = [ShortField('client_id', 0),ShortField('session_id', 0)]def extract_padding(self, p):return '', pclass SOMEIP(Packet):""" SOME/IP Packet."""# Default valuesPROTOCOL_VERSION = 0x01INTERFACE_VERSION = 0x01# Lenght offset (without payload)LEN_OFFSET = 0x08# SOME/IP TYPE VALUESTYPE_REQUEST = 0x00TYPE_REQUEST_NO_RET = 0x01TYPE_NOTIFICATION = 0x02TYPE_REQUEST_ACK = 0x40TYPE_REQUEST_NORET_ACK = 0x41TYPE_NOTIFICATION_ACK = 0x42TYPE_RESPONSE = 0x80TYPE_ERROR = 0x81TYPE_RESPONSE_ACK = 0xc0TYPE_ERROR_ACK = 0xc1# SOME/IP-TP TYPE VALUESTYPE_REQUEST_SEGMENT = 0x20TYPE_REQUEST_NO_RET_SEGMENT = 0x21TYPE_NOTIFICATION_SEGMENT = 0x22TYPE_REQUEST_ACK_SEGMENT = 0x60TYPE_REQUEST_NORET_ACK_SEGMENT = 0x61TYPE_NOTIFICATION_ACK_SEGMENT = 0x62TYPE_RESPONSE_SEGMENT = 0xa0TYPE_ERROR_SEGMENT = 0xa1TYPE_RESPONSE_ACK_SEGMENT = 0xe0TYPE_ERROR_ACK_SEGMENT = 0xe1SOMEIP_TP_TYPES = frozenset({TYPE_REQUEST_SEGMENT, TYPE_REQUEST_NO_RET_SEGMENT, TYPE_NOTIFICATION_SEGMENT,TYPE_REQUEST_ACK_SEGMENT, TYPE_REQUEST_NORET_ACK_SEGMENT,TYPE_NOTIFICATION_ACK_SEGMENT, TYPE_RESPONSE_SEGMENT, TYPE_ERROR_SEGMENT,TYPE_RESPONSE_ACK_SEGMENT, TYPE_ERROR_ACK_SEGMENT})SOMEIP_TP_TYPE_BIT_MASK = 0x20# SOME/IP RETURN CODESRET_E_OK = 0x00RET_E_NOT_OK = 0x01RET_E_UNKNOWN_SERVICE = 0x02RET_E_UNKNOWN_METHOD = 0x03RET_E_NOT_READY = 0x04RET_E_NOT_REACHABLE = 0x05RET_E_TIMEOUT = 0x06RET_E_WRONG_PROTOCOL_V = 0x07RET_E_WRONG_INTERFACE_V = 0x08RET_E_MALFORMED_MSG = 0x09RET_E_WRONG_MESSAGE_TYPE = 0x0a# SOME/IP-TP More Segments FlagSOMEIP_TP_LAST_SEGMENT = 0SOMEIP_TP_MORE_SEGMENTS = 1_OVERALL_LEN_NOPAYLOAD = 16  # UTname = 'SOME/IP'fields_desc = [PacketField('msg_id', _SOMEIP_MessageId(), _SOMEIP_MessageId),  # MessageIDIntField('len', None),  # LengthPacketField('req_id', _SOMEIP_RequestId(), _SOMEIP_RequestId),  # RequestIDByteField('proto_ver', PROTOCOL_VERSION),  # Protocol versionByteField('iface_ver', INTERFACE_VERSION),  # Interface versionByteEnumField('msg_type', TYPE_REQUEST, {  # -- Message type --TYPE_REQUEST: 'REQUEST',  # 0x00TYPE_REQUEST_NO_RET: 'REQUEST_NO_RETURN',  # 0x01TYPE_NOTIFICATION: 'NOTIFICATION',  # 0x02TYPE_REQUEST_ACK: 'REQUEST_ACK',  # 0x40TYPE_REQUEST_NORET_ACK: 'REQUEST_NO_RETURN_ACK',  # 0x41TYPE_NOTIFICATION_ACK: 'NOTIFICATION_ACK',  # 0x42TYPE_RESPONSE: 'RESPONSE',  # 0x80TYPE_ERROR: 'ERROR',  # 0x81TYPE_RESPONSE_ACK: 'RESPONSE_ACK',  # 0xc0TYPE_ERROR_ACK: 'ERROR_ACK',  # 0xc1}),ByteEnumField('retcode', 0, {  # -- Return code --RET_E_OK: 'E_OK',  # 0x00RET_E_NOT_OK: 'E_NOT_OK',  # 0x01RET_E_UNKNOWN_SERVICE: 'E_UNKNOWN_SERVICE',  # 0x02RET_E_UNKNOWN_METHOD: 'E_UNKNOWN_METHOD',  # 0x03RET_E_NOT_READY: 'E_NOT_READY',  # 0x04RET_E_NOT_REACHABLE: 'E_NOT_REACHABLE',  # 0x05RET_E_TIMEOUT: 'E_TIMEOUT',  # 0x06RET_E_WRONG_PROTOCOL_V: 'E_WRONG_PROTOCOL_VERSION',  # 0x07RET_E_WRONG_INTERFACE_V: 'E_WRONG_INTERFACE_VERSION',  # 0x08RET_E_MALFORMED_MSG: 'E_MALFORMED_MESSAGE',  # 0x09RET_E_WRONG_MESSAGE_TYPE: 'E_WRONG_MESSAGE_TYPE',  # 0x0a}),ConditionalField(BitField('offset', 0, 28), lambda pkt: pkt.msg_type in SOMEIP.SOMEIP_TP_TYPES),ConditionalField(BitField('reserved', 0, 3), lambda pkt: pkt.msg_type in SOMEIP.SOMEIP_TP_TYPES),ConditionalField(BitEnumField('more_segments', 0, 1, {SOMEIP_TP_LAST_SEGMENT: 'Last_Segment',SOMEIP_TP_MORE_SEGMENTS: 'More_Segments'}), lambda pkt: pkt.msg_type in SOMEIP.SOMEIP_TP_TYPES)]def post_build(self, p, pay):length = self.len# length computation : RequestID + PROTOVER_IFACEVER_TYPE_RETCODE + PAYLOADif length is None:length = self.LEN_OFFSET + len(pay)p = p[:4] + struct.pack('!I', length) + p[8:]return p + payfor i in range(15):bind_layers(UDP, SOMEIP, sport=30490 + i)bind_layers(TCP, SOMEIP, sport=30490 + i)

3、network_define.py

class EthParameter:# 广播sd_network_card = "eth0.62"sd_ip = "239.0.0.255"# 本机server_network_card = "Realtek PCIe GbE Family Controller #2"server_ip = "192.168.62.31"# 域控client_network_card = "eth0.62"client_ip = "192.168.62.11"sd_port = 30490producer_port = 30500consumer_prot = 30501

4、packet_define.py

import eth_scapy_sd as sdfrom network_define import EthParameterfrom scapy.layers.l2 import Ether
from scapy.layers.inet import IP, UDPclass SomeipPacker:def __init__(self):self.eth_para = EthParameter()self.sd_session_id = 1self.client_session_id = 1def update_sd_session_id(self):"""更新session_id,从0递增到65535"""self.sd_session_id += 1if self.sd_session_id >= 65535:self.sd_session_id = 0def update_client_session_id(self):self.client_session_id += 1if self.client_session_id >= 65535:self.client_session_id = 0# ===========================##          序列化             ## ===========================#def packet_subscribe(self, service_id: list, ttl: int):"""组事件订阅包"""subscribe_packager = sd.SD()subscribe_packager.setFlag("REBOOT", 1)subscribe_packager.setFlag("UNICAST", 1)subscribe_packager.len_entry_array = 16 * len(service_id)subscribe_packager.len_option_array = 24for i in service_id:subscribe_packager.entry_array.append(sd.SDEntry_EventGroup(type=sd.SDEntry_EventGroup.TYPE_EVTGRP_SUBSCRIBE,srv_id=i,inst_id=0x1,n_opt_1=2,major_ver=0x1,ttl=ttl,eventgroup_id=0x1,))subscribe_packager.option_array = [# UDP EndPointsd.SDOption_IP4_EndPoint(addr=self.eth_para.server_ip,l4_proto=0x11,port=self.eth_para.consumer_prot,),# TCP EndPointsd.SDOption_IP4_EndPoint(addr=self.eth_para.server_ip,l4_proto=0x06,port=self.eth_para.consumer_prot,),]print(subscribe_packager.show())subscribe_package = (Ether()/ IP(src=self.eth_para.server_ip, dst=self.eth_para.client_ip)/ UDP(sport=self.eth_para.sd_port, dport=self.eth_para.sd_port)/ subscribe_packager.get_someip_with_session_id(self.client_session_id, True))self.update_client_session_id()return subscribe_packagedef packet_subscribe_ack(self, service_id: list, ttl: int):"""组ack包"""ack_packager = sd.SD()ack_packager.setFlag("REBOOT", 1)ack_packager.setFlag("UNICAST", 1)ack_packager.len_entry_array = 16 * len(service_id)ack_packager.len_option_array = 0for i in service_id:ack_packager.entry_array.append(sd.SDEntry_EventGroup(type=sd.SDEntry_EventGroup.TYPE_EVTGRP_SUBSCRIBE_ACK,srv_id=i,inst_id=0x1,major_ver=0x1,ttl=ttl,eventgroup_id=0x1,))print(ack_packager.show())ack_package = (Ether()/ IP(src=self.eth_para.server_ip, dst=self.eth_para.client_ip)/ UDP(sport=self.eth_para.sd_port, dport=self.eth_para.sd_port)/ ack_packager.get_someip_with_session_id(self.client_session_id, True))self.update_client_session_id()return ack_packagedef packet_offer(self, service_id: list, ttl: int):"""组offer包"""offer_packager = sd.SD()offer_packager.setFlag("REBOOT", 1)offer_packager.setFlag("UNICAST", 1)offer_packager.len_entry_array = 16 * len(service_id)offer_packager.len_option_array = 12for i in service_id:offer_packager.entry_array.append(sd.SDEntry_Service(type=sd.SDEntry_Service.TYPE_SRV_OFFERSERVICE,srv_id=i,inst_id=0x1,n_opt_1=1,major_ver=0x1,minor_ver=0x01,ttl=ttl,))offer_packager.option_array = [sd.SDOption_IP4_EndPoint(addr=self.eth_para.server_ip,l4_proto=0x11,port=self.eth_para.producer_port,)]print(offer_packager.show())offer_package = (Ether()/ IP(src=self.eth_para.server_ip, dst=self.eth_para.sd_ip)/ UDP(sport=self.eth_para.sd_port, dport=self.eth_para.sd_port)/ offer_packager.get_someip_with_session_id(self.sd_session_id, True))self.update_sd_session_id()return offer_package

5、unpack_define.py

from scapy.packet import Raw
from typing import Optional
from dataclasses import dataclass@dataclass
class SomeIPHeaderParams:service_id: intevent_id: int      # 或 event_id,取决于消息类型client_id: intsession_id: intmsg_type: intreturn_code: intlength: intprotocol_version: intinterface_version: intclass SomeipUnpacker:@staticmethoddef get_someip_header_params(receive_packet) -> Optional[SomeIPHeaderParams]:"""获取someip header"""try:if receive_packet.haslayer("SOME/IP"):someip_layer = receive_packet["SOME/IP"]# 获取someip header值service_id = someip_layer.msg_id.srv_idsub_id = someip_layer.msg_id.sub_idevent_id = sub_id << 15 | someip_layer.msg_id.event_id# 提取请求 ID(Client ID 和 Session ID)req_id = someip_layer.req_idclient_id = req_id.client_idsession_id = req_id.session_id# 构造头部对象return SomeIPHeaderParams(service_id=service_id,event_id=event_id,client_id=client_id,session_id=session_id,msg_type=someip_layer.msg_type,return_code=someip_layer.retcode,length=someip_layer.len,protocol_version=someip_layer.proto_ver,interface_version=someip_layer.iface_ver,)except (AttributeError, ValueError) as e:print(f"解析失败: {e}")return None@staticmethoddef get_someip_payload(receive_packet):"""获取someip payload"""try:someip_payload = receive_packet[Raw].load# print(f"someip_payload: {someip_payload}")return someip_payloadexcept AttributeError:return None

6、someip_controller.py

import threading
import socket
import time
from module.packet_define import *
from module.unpack_define import *from scapy.sendrecv import sendp, sniffclass SomeipController(threading.Thread):def __init__(self, someip_packer: SomeipPacker, someip_unpacker: SomeipUnpacker):super().__init__()self.someip_packer = someip_packerself.someip_unpacker = someip_unpackerself._stop_event = threading.Event()self.running = Truedef run(self):# 创建并发送offer以及订阅ack报文(这里忽略订阅,直接回复订阅ack)service_id_list = [0xA994, 0xA995]_offer = self.someip_packer.packet_offer(service_id=service_id_list,ttl=3)_offer_sender = SomeipSendLoop(network_card=EthParameter.sd_network_card,someip_packer=_offer,cycle_time_ms=2000,)# 回复订阅ACK_subscribe_ack = self.someip_packer.packet_subscribe_ack(service_id=service_id_list,ttl=3)_subscribe_ack_sender = SomeipSendLoop(network_card=EthParameter.sd_network_card,someip_packer=_subscribe_ack,cycle_time_ms=2000,)# 创建并发送订阅报文(订阅0xAB03, 0xAB04)_subscribe = self.someip_packer.packet_subscribe(service_id=[0xAB03,0xAB04], ttl=0x03)_subscribe_sender = SomeipSendLoop(network_card=EthParameter.server_network_card,someip_packer=_subscribe,cycle_time_ms=2000,)# 启动接收模块someip_receiver = SomeIpReceiver(EthParameter.server_network_card)while self._stop_event:time.sleep(0.01)def stop(self):self.running = False  # 设置标志位为 False 来停止self._stop_event.set()self.join()class SomeipSendLoop(threading.Thread):def __init__(self, network_card, someip_packer, cycle_time_ms):super().__init__()self.network_card = network_cardself.someip_packer = someip_packerself.cycle_time_ms = cycle_time_msself._stop_event = threading.Event()self.start()def run(self):while self._stop_event:if self.someip_packer:sendp(self.someip_packer, iface=self.network_card, verbose=0)time.sleep(self.cycle_time_ms / 1000)def stop(self):self._stop_event.set()self.join()class SomeIpReceiver(threading.Thread):def __init__(self,eth_desc: str,someip_unpacker):super().__init__()self._eth_desc = eth_descself._unpacker = someip_unpackerself._terminated = Falseself._stop_event =threading.Event()self.start()def packet_callback(self, packet):if packet:header_param = self._unpacker.get_someip_header_params(receive_packet=packet)print(f"msg_type: {header_param.msg_type}")def run(self):sniff(iface=self._eth_desc,prn=self.packet_callback,filter="udp",stop_filter=lambda x: self._terminated,)while self._stop_event:# 保持sniff嗅探不中断time.sleep(1)def stop(self):self._terminated = Trueself._stop_event.set()self.join()# 如果协议有TCP
class SomeipTcpSocket(threading.Thread):def __init__(self):super().__init__()self.tcp_sock: socket = Noneself._stop_event = threading.Event()self.start()def create_tcp_socket(self):self.tcp_sock = socket.socket(socket.AF_INET, socket.SOCK_STREAM)self.tcp_sock.setsockopt(socket.SOL_SOCKET, socket.SO_REUSEADDR, 1)self.tcp_sock.bind((EthParameter.icc_android_ip, EthParameter.consumer_prot))self.tcp_sock.connect((EthParameter.adcc_ip, EthParameter.producer_port))def run(self):self.create_tcp_socket()while self._stop_event:# 保持TCP通信time.sleep(1)def stop(self):self._stop_event.set()self.join()if __name__ == "__main__":s_socket = SomeipTcpSocket()s_packer = SomeipPacker()s_unpacker = SomeipUnpacker()sim_server = SomeipController(s_packer,s_unpacker)sim_server.start()

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.rhkb.cn/news/34010.html

如若内容造成侵权/违法违规/事实不符,请联系长河编程网进行投诉反馈email:809451989@qq.com,一经查实,立即删除!

相关文章

XSS漏洞学习(1)

XSS漏洞学习&#xff08;1&#xff09; HTTP协议回顾 HTTP的请求方式 常用 GET 请求从服务器获取资源 HEAD 类似于GET请求&#xff0c;只不过不会返回实体数据&#xff0c;只获取报头 POST 向服务器提交数据 PUT 替换服务器的内容 不常用 DELETE 请求服务器删除指定的…

【统计学相关笔记】抽样基本定理的证明

抽样基本定理的证明 法 1 法 2 什么是 辅助统计量&#xff1f; 法 3

基于Asp.net的物流配送管理系统

作者&#xff1a;计算机学姐 开发技术&#xff1a;SpringBoot、SSM、Vue、MySQL、JSP、ElementUI、Python、小程序等&#xff0c;“文末源码”。 专栏推荐&#xff1a;前后端分离项目源码、SpringBoot项目源码、Vue项目源码、SSM项目源码、微信小程序源码 精品专栏&#xff1a;…

vue-treeselect 【单选/多选】的时候只选择最后一层(绑定的值只绑定最后一层)

欢迎访问我的个人博客 &#xff5c;snows_ls BLOGhttp://snows-l.site 一、单选 1、问题&#xff1a; vue-treeselect 单选的时候只选择最后一层&#xff08;绑定的值只绑定最后一层&#xff09; 2、方法 1、只需要加上 :disable-branch-nodes"true" 就行&#xff0…

Python的那些事第四十五篇:继承自Nose的测试框架Nose2

Nose2:继承自Nose的测试框架 摘要 本文深入探讨了Nose2这一继承自Nose的测试框架。在软件开发过程中,测试是确保代码质量和稳定性的重要环节,而测试框架为测试工作的开展提供了有力支持。Nose2作为Nose的继承者,在保留Nose优势的基础上进行了诸多改进和扩展,为Python测试…

LLM后训练:解锁大型语言模型推理能力的关键路径

引言&#xff1a;从语言生成到逻辑推理的跃迁 大型语言模型&#xff08;LLMs&#xff09;通过预训练掌握了海量语言模式&#xff0c;但其核心缺陷——幻觉、逻辑断裂、价值观偏差——暴露了单纯预训练的局限性。后训练&#xff08;Post-Training&#xff09;作为预训练后的精修…

Rabit

之前发过rabit了&#xff0c;所以这里不再赘述&#xff0c;讲讲原理 在线Rabbit加密 | Rabbit解密- 在线工具 (sojson.com) rabbit加密原理 Rabbit加密算法是一种流密码算法&#xff0c;由Daniel J. Bernstein设计&#xff0c;并被广泛用于多种加密和安全通信应用中。它的设…

coding ability 展开第四幕(滑动指针——巩固篇)超详细!!!!

文章目录 前言水果成篮思路 找到字符串中所有字母异位词思路 串联所有单词的子串思路 最小覆盖子串思路 总结 前言 本专栏上一篇博客&#xff0c;带着大家从认识滑动窗口到慢慢熟悉 相信大家对滑动窗口已经有了大概的认识 其实主要就是抓住——一段连续的区间 今天来学习一些滑…

“消失的中断“

“消失的中断” 1. 前言 在嵌入式开发过程中&#xff0c;中断必不可少。道友们想必也经常因为中断问题头疼不已&#xff0c;今天来说说一个很常见的问题&#xff0c;“消失的中断”。最近项目在使用第三方MCAL的时候&#xff0c;就遇到了I2C中断丢失的问题&#xff0c;排查起…

阿里云魔笔低代码应用开发平台快速搭建教程

AI低代码&#xff0c;大模型时代应用开发新范式 什么是魔笔 介绍什么是魔笔低代码应用开发平台。 魔笔是一款面向全端&#xff08;Web、H5、全平台小程序、App&#xff09;场景的模型驱动低代码开发平台&#xff0c;提供一站式的应用全生命周期管理&#xff0c;包括可视化开发…

Obsidian Copilot:打造你的专属 AI 笔记助手

Obsidian Copilot作为一款非常受欢迎的Obsidian插件&#xff0c;不仅极大地提升了用户的笔记管理和信息检索效率&#xff0c;还通过其多样化的AI功能为用户带来了前所未有的便捷体验。本文将详细介绍Obsidian Copilot的核心特点、使用方法及个人体验分享。 核心特点 Obsidian…

聊聊 Redis 的一些有趣的特性(上)

聊聊 Redis 的一些有趣的特性&#xff08;上&#xff09; 一、持久化 Redis 是内存数据库&#xff0c;数据全部保存在内存中。如果服务器发生宕机&#xff0c;内存中的数据将会全部丢失。为防止系统崩溃后数据丢失&#xff0c;Redis 提供了持久化功能&#xff0c;可将内存中的…

【结构设计】3D打印创想三维Ender 3 v2

【结构设计】3D打印创想三维Ender 3 v2 文章目录 前言一、Creality Slicer1.2.3打印参数设置二、配件更换1.捆扎绑扎线2.气动接头3D打印机配件插头3.3D打印机配件Ender3pro/V2喷头套件4.读卡器 TF卡5.micro sd卡 三、调平四、参考文章总结 前言 使用工具&#xff1a; 1.创想三…

吴恩达机器学习笔记复盘(五)均方误差函数

只讲了线性回归的代价函数。 均方误差&#xff08;Mean Squared Error, MSE&#xff09; 均方误差&#xff08;MSE&#xff09;基于最小二乘法&#xff0c;通过计算预测值与真实值之间差值的平方的平均值来衡量模型的误差。 原理 假设我们有一组数据集&#xff0c;其中是第…

Vue生命周期_Vue生命周期钩子

一、生命周期介绍 每个 Vue 组件实例在创建时都需要经历一系列的初始化步骤&#xff0c;比如设置好数据侦听&#xff0c;编译模板&#xff0c;挂载实例到 DOM&#xff0c;以及在数据改变时更新 DOM。 在此过程中&#xff0c;它也会运行被称为生命周期钩子的函数&#xff0c;让…

arthas常用命令

文章目录 1. dashboard仪表板2. 通过thread命令来获取到math-game.jar进程的Main Class3. 通过jad来反编译Main Class4. watch监视5. 退出arthas6. 小结 欢迎关注 性能测试和优化 专栏&#xff1a;https://blog.csdn.net/qq_41684621/category_12910565.html 1. dashboard仪表…

c#Winform也可以跨平台了GTK框架GTKSystem.Windows.Forms

一、简介 >> 新版下载&#xff0c;问题求助 QQ群&#xff1a;1011147488 1032313876 236066073&#xff08;满&#xff09; Visual Studio原生开发&#xff0c;无需学习&#xff0c;一次编译&#xff0c;跨平台运行. C#桌面应用程序跨平台&#xff08;windows、linux、…

Vue3 Pinia的getters属性

Pinia的getters属性 定义一个bigSum&#xff0c;值是sum*10 可以写成箭头函数的形式upperSchool中使用了this&#xff0c;不能写成箭头函数的形式

Atcoder ABC397-D 题解

https://atcoder.jp/contests/abc397/tasks/abc397_dhttps://atcoder.jp/contests/abc397/tasks/abc397_d 题目描述&#xff1a; 确定是否存在一对正整数,使得 思路&#xff1a; 首先对方程进行转化 设 即 接下来确定的范围 根据立方差公式 因此&#xff0c;我们可以从到来…

医疗送药机器人“空间拓扑优化+动态算法决策+多级容错控制”三重链式编程技术解析与应用

一、引言 1.1 研究背景与意义 在医疗体系中,高效精准的药品配送是保障医疗服务质量和患者安全的关键环节。随着医疗技术的不断进步和医疗需求的日益增长,传统的人工送药方式逐渐暴露出诸多弊端,如配送效率低下、易受人为因素干扰导致错误率上升、人力成本高昂等。特别是在…