hXddlZddlZddlZddlZddlmZmZmZmZm Z m Z ddl m Z ddl mZddlmZddlmZmZmZmZmZmZmZmZmZmZmZddlmZmZddl m!Z!m"Z"m#Z#dd l$m%Z%Gd d e!Z&e#ee&d e#ee&d e"ee&d d e"ee&d e"ee&d e"e&edGdde%Z'Gdde'Z(Gdde(Z)dS)N)AnyUnionTupleOptionalDictType)log_automotive)UDS)MTU) ByteEnumFieldConditionalFieldIntFieldMayEndStrFixedLenFieldXByteEnumField XByteField XIntFieldXShortEnumField XShortField XStrField)TCPUDP)Packet bind_layersbind_bottom_up)SSLStreamSocketc)eZdZdZidddddddd d d d d ddddddddddddddddddd d!ZdZed"ded#d$ed%deed&d'e e d(dd)d*d+d,d-d.d/e e d0d1d2d3e e d4dd5e e d6d1dd7e e d8d1dd9e e ed:didd;dd<dd<dd<d d<d d<dd<dd<dd<d=d<d>d<d?d<d@d<dAd<dBd<dCd<dDdEdFe edGdiddHdd<dd<dd<d d<d d<dd<dd<dd<d=d<d>d<d?d<d@d<dAd<dBd<dCd<dDdIdJe e dKddLe edMddNdOdPdNdQdPdRdSe e dTddUe e dVddWe edXdiddYddZdd[dd\d d]d d^dd_dd`ddad=dad>dad?dad@dadAdadBdadCdadDdbd2dcidde ededdfe edgd1dhe ediddjdkdldmdne e doddpdqdrdse edtddue edvddwe edxddye e dzdd{e ed|ddd}id~e e ddd>> socket = L3RawSocket(iface="eth0") >>> resp = socket.sr1(IP(dst="169.254.117.238")/UDP(dport=13400)/DoIP(payload_type=1)) Example with TCP: >>> socket = DoIPSocket("169.254.117.238") >>> pkt = DoIP(payload_type=0x8001, source_address=0xe80, target_address=0x1000) / UDS() / UDS_RDBI(identifiers=[0x1000]) >>> resp = socket.sr1(pkt, timeout=1) Example with UDS: >>> socket = UDS_DoIPSocket("169.254.117.238") >>> pkt = UDS() / UDS_RDBI(identifiers=[0x1000]) >>> resp = socket.sr1(pkt, timeout=1) rzGeneric DoIP header NACKzVehicle identification requestz'Vehicle identification request with EIDz'Vehicle identification request with VINzDVehicle announcement message/vehicle identification response messagezRouting activation requestzRouting activation responsezAlive check requestzAlive check response@zDoIP entity status request@zDoIP entity status response@z)Diagnostic power mode information request@z*Diagnostic power mode information responsezDiagnostic messagezDiagnostic message ACKzDiagnostic message NACKprotocol_versioninverse_version payload_typepayload_lengthNnackzIncorrect pattern formatzUnknown payload typezMessage too largez Out of memoryzInvalid payload length)rrr r!r"c|jdvS)N)rr1ps a/mounts/lovelace/software/anaconda3/lib/python3.11/site-packages/scapy/contrib/automotive/doip.pyz DoIP.s an-vinr:c|jdvS)N)r!r"r5r6s r8r9z DoIP. 1>V#;r:logical_addressc|jdvSN)r"r5r6s r8r9z DoIP. 1>S#8r:eidc|jdvS)N)r r"r5r6s r8r9z DoIP.r>r:gidc|jdvSrAr5r6s r8r9z DoIP.rBr:further_actionzNo further action requiredzReserved by ISO 13400 z8Routing activation required to initiate central securityc|jdvSrAr5r6s r8r9z DoIP.s q~,r:vin_gid_statuszVIN and/or GID are synchronizedz,Incomplete: VIN and GID are NOT synchronizedc|jdvSrAr5r6s r8r9z DoIP. an+r:source_addressc|jdvS)N)r#r&r+r,r-r5r6s r8r9z DoIP.s1>5S#Sr:activation_typeDefaultzWWH-OBDzCentral security Diagnostic)rriic|jdvS)N)r#r5r6s r8r9z DoIP.rSr:logical_address_testerc|jdvSN)r$r5r6s r8r9z DoIP.rBr:logical_address_doip_entityc|jdvSr^r5r6s r8r9z DoIP.rBr:routing_activation_responsez8Routing activation denied due to unknown source address.zhRouting activation denied because all concurrently supported TCP_DATA sockets are registered and active.zRouting activation denied because an SA different from the table connection entry was received on the already activated TCP_DATA socket.ziRouting activation denied because the SA is already registered and active on a different TCP_DATA socket.z8Routing activation denied due to missing authentication.z7Routing activation denied due to rejected confirmation.zERouting activation denied due to unsupported routing activation type.zfRouting activation denied because the specified activation type requires a secure TLS TCP_DATA socket.zReserved by ISO 13400.zRouting successfully activated.z1Routing will be activated; confirmation required.c|jdvSr^r5r6s r8r9z DoIP.rSr: reserved_isoc|jdvSN)r#r$r5r6s r8r9z DoIP.r>r: reserved_oemc|jdvSrer5r6s r8r9z DoIP.r>r:diagnostic_power_modez not readyreadyz not supported)rrr c|jdvS)N)r*r5r6s r8r9z DoIP. an0r: node_typez DoIP gatewayz DoIP node)rrc|jdvSN)r(r5r6s r8r9z DoIP.rkr:max_open_socketsc|jdvSrnr5r6s r8r9z DoIP. 1>X#=r:cur_open_socketsc|jdvSrnr5r6s r8r9z DoIP.rqr: max_data_sizec|jdvSrnr5r6s r8r9z DoIP.rqr:target_addressc|jdvS)Nr+r,r-r5r6s r8r9z DoIP.s1>5M#Mr:ack_codeACKc|jdvS)N)r,r5r6s r8r9z DoIP.rqr: nack_codezInvalid source addresszUnknown target addresszDiagnostic message too largezTarget unreachablezUnknown networkzTransport protocol error) rrr r!r"r#r$r%r&c|jdvS)N)r-r5r6s r8r9z DoIP.rkr: previous_msgc|jdvS)N)r,r-r5r6s r8r9z DoIP.s1>5E#Er:ct|t|rM|jdkrdSgd}|j|jf|vr,|jdkr|j|jSdSdS)z)DEV: true if self is an answer from otherrr) )r"r)r"r )r"r!)r$r#)r&r%)r(r')r*r))r+r+)r-r+r+) isinstancetyper1payloadanswers)selfothermatchess r8rz DoIP.answerss eT$ZZ ( (  A%%q;;;G!5#56'AA$..<// >>>qqr:c|jdvr:t|ddtjd|j|jz zSt|ddS)Nrxr H)r1bytesstructpackrvrT)rs r8hashretz DoIP.hashretsb   8 8 8;;rr?V[T(4+>>&@&@@ @T{{2A2r:c|jK|ddtjdt|t|zdz z|ddz}||zS)zP This will set the Field 'payload_length' to the correct value. Nr"!Ir&)r2rrlen)rpktpays r8 post_buildzDoIP.post_buildsb   &bqb'FKc#hhS)A-///14QRR9CSyr:ch|jdkr$|d|jdz ||jdz dfSd|fS)Nr+r"r:)r1r2)rss r8extract_paddingzDoIP.extract_paddingsJ   & &-d)A--.$2E2I2J2J0KK K6Mr:ctjd|ddddz}t||krt|SdS)Nrr"r&r)runpackrr)clsdatametadatasessionlengths r8tcp_reassemblezDoIP.tcp_reassemblesItT!A#Y//2Q6 t99  :: tr:)__name__ __module__ __qualname____doc__ payload_typesnamerrrr r rrrrrr fields_descrrrr classmethodrr:r8rr0s66n+*+0+ 9+ 9 + V + , + -+ %+ &+ ,+ -+ ;+ <+ $+ (+ )!+M" D %t,, $d++=99!4((vq).D"'3 3    . -  / / ))%b99;; = =%6::88 : :))%a88;; = =))%a8888 : :/? E . E ) E +/1H E  ) E ,01H E  ) E ,01H E ) E ,01H E ) E ,01H E  ) E ,01H E  ) E ,01H E  ) E  L E ! !   - , . . (8! > 3 > ) > +/1H >  ) > ,01H >  ) > ,01H > ) > ,01H > ) > ,01H >  ) > ,01H >  ) > ,01H >  ) >  @ >    , + - - %5q99SS U U(91Y.@L:L? ?    , + - - %=qAA88 : :%BAFF88 : :(EqK LK |K  ]K  } K L K K K  YK  zK  *K  *K -12JK  *K -12JK  *K -12JK  *K  3K  EK K   , +! - -" >155;; = =>377;; = =(?w?E E   0 0 2 2 {A+8 8   0 0 2 2 $6::== ? ?$6::== ? ?/155== ? ?%5q99MM O O A5zBB== ? ?{A)1H*2J0&.?, 8 8   1 0  2 2 >377EE G GEdKL [r:rX4)sport)dport)rrr+r5c.eZdZdZdfd ZefdZxZS)DoIPSSLStreamSocketz3Custom SSLStreamSocket for DoIP communication. Ncvtt|||ptd|_dS)Nr:)superr__init__rbuffer)rsockbasecls __class__s r8rzDoIPSSLStreamSocket.__init__s3 !4((11$4HHH r:c 8t|jdkr(|xj|jdz c_t|jdkrdS|jdd}t jd|ddd}|dz }|xj|j|t|jz z c_t|j|krdS|jd|}|j|d|_|j|fi|}|S)Nr&z>Ir"r)rrinsrecvrrr)rxkwargslen_datalen_intpktbufrs r8rzDoIPSSLStreamSocket.recv$s  t{  a   KK48==++ +KK t{  a  4;rr?-hqsm44Q71  tx}}Ws4;/?/?%?@@@ t{  g % %4XgX&k'((+ dl6,,V,, r:N)rrrrrr r __classcell__rs@r8rrs` r:rc:eZdZdZ dd Zd Zd Zd S) DoIPSocketabSocket for DoIP communication. This sockets automatically sends a routing activation request as soon as a TCP or TLS connection is established. :param ip: IP address of destination :param port: destination port, usually 13400 :param tls_port: destination port for TLS connection, usually 3496 :param activate_routing: If true, routing activation request is automatically sent :param source_address: DoIP source address :param target_address: DoIP target address, this is automatically determined if routing activation request is sent :param activation_type: This allows to set a different activation type for the routing activation request :param reserved_oem: Optional parameter to set value for reserved_oem field of routing activation request :param force_tls: Skip establishing of a TCP connection and directly try to connect via SSL/TLS :param context: Optional ssl.SSLContext object for initialization of ssl socket connections. Example: >>> socket = DoIPSocket("169.254.0.131") >>> pkt = DoIP(payload_type=0x8001, source_address=0xe80, target_address=0x1000) / UDS() / UDS_RDBI(identifiers=[0x1000]) >>> resp = socket.sr1(pkt, timeout=1) 127.0.0.1r Trr:FNc ||_||_||_||_||_||_||_||_| |_| |_ | dS#t$r| wxYwr) ipporttls_portactivate_routingrTrvrVrf force_tlscontext _init_socket Exceptionclose) rrrrrrTrvrVrfrrs r8rzDoIPSocket.__init__Us   0,,.("              JJLLL  s A A>cd}tj|j|jtj}|dd}tj|tj}|d|tjtjd|tj tj d|j s\| |ddd}t|||jsdS|}nd}|d krdS|dkrn|jt%d |r|tj|tj}|d|tjtjd|tj tj d|j|}tj|j|jtj}| |ddt|||jsdS|}|d krdSt-d |z|dkrt-d t-d |z)NF)protorr#rTr%rOz$SSLContext 'context' can not be NonezHDoIPSocket activate_routing failed with routing_activation_response 0x%xz#DoIPSocket._activate_routing failedzIDoIPSocket activate_routing failed with routing_activation_response 0x%x!)socket getaddrinforr IPPROTO_TCP SOCK_STREAM settimeout setsockopt TCP_NODELAY SOL_SOCKET SO_REUSEADDRrconnectrrr_activate_routingr ValueErrorr wrap_socketrr)r connectedaddrinfo sock_familyractivation_returnsss r8rzDoIPSocket._init_socketqs %dgty@RSSSqk!n M+v'9 : : Q V');Q??? V&(;Q???~ % IIhqk"o & & &I  ( (q 1 1 1(  $ 6 6 8 8  !%   $ $ F $ & &|# !GHHH H M+v/ABB Q V/1CQGGG V.0CQGGG))!,,B)f.@BBBH JJx{2 ' ' '  ( (r 2 2 2(  $ 6 6 8 8  D((79JKLLL" $ $ABB B46GHII Ir:cn|td|j|j|jdd}|rD|jdkr9|jdkr.|jp|j|_tj d|jn"tj d t||r|jdkr|jSd S) Nr#)r1rVrTrfFr)verbosetimeoutr$rOz:Routing activation successful! Target address set to: 0x%xz'Routing activation failed! Response: %sr) sr1rrVrTrfr1rarvr_r infoerrorrepr)rresps r8rzDoIPSocket._activate_routingsxx c43G $ 3$BS U U U1&&  GD%,,0D88#Gt'G    L# % % % %  94:: G G G  D%,,3 32r:) rrrTrrrr:FN)rrrrrrrrr:r8rr9st8 "& % !!"! 8>I>I>I@r:rc0eZdZdZfdZeffd ZxZS)UDS_DoIPSocketa7 Application-Layer socket for DoIP endpoints. This socket takes care about the encapsulation of UDS packets into DoIP packets. Example: >>> socket = UDS_DoIPSocket("169.254.117.238") >>> pkt = UDS() / UDS_RDBI(identifiers=[0x1000]) >>> resp = socket.sr1(pkt, timeout=1) ct|tr td|j|j|z }n|} t j|_n#t$rYnwxYwt |S)Nr+)r1rTrv) rr rrTrvtime sent_timeAttributeErrorrsend)rrrrs r8rzUDS_DoIPSocket.sends a   F&*&9&*&9CC C )++AKK    D ww||C   sA A A c dtj|fi|}|r|jdkr|jS|S)Nr+)rrr1r)rrrrrs r8rzUDS_DoIPSocket.recvsBeggl1''''  3#v--; Jr:)rrrrrr rrrs@r8rrs\!!!!!" DDDr:r)*rsslrrtypingrrrrrrscapy.contrib.automotiver scapy.contrib.automotive.udsr scapy.datar scapy.fieldsr r rrrrrrrrrscapy.layers.inetrr scapy.packetrrrscapy.supersocketrrrrrrr:r8rs 433333,,,,,,                          '&&&&&&&<<<<<<<<<<------ ^^^^^6^^^BsD&&&&sD&&&& CU%0000 CU#### CU#### D#F++++/