1*ed775ee7SAntonio Huete Jimenez /*
2*ed775ee7SAntonio Huete Jimenez * Redistribution and use in source and binary forms, with or without
3*ed775ee7SAntonio Huete Jimenez * modification, are permitted provided that: (1) source code
4*ed775ee7SAntonio Huete Jimenez * distributions retain the above copyright notice and this paragraph
5*ed775ee7SAntonio Huete Jimenez * in its entirety, and (2) distributions including binary code include
6*ed775ee7SAntonio Huete Jimenez * the above copyright notice and this paragraph in its entirety in
7*ed775ee7SAntonio Huete Jimenez * the documentation or other materials provided with the distribution.
8*ed775ee7SAntonio Huete Jimenez * THIS SOFTWARE IS PROVIDED ``AS IS'' AND
9*ed775ee7SAntonio Huete Jimenez * WITHOUT ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, WITHOUT
10*ed775ee7SAntonio Huete Jimenez * LIMITATION, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
11*ed775ee7SAntonio Huete Jimenez * FOR A PARTICULAR PURPOSE.
12*ed775ee7SAntonio Huete Jimenez *
13*ed775ee7SAntonio Huete Jimenez * Original code by Francesco Fondelli (francesco dot fondelli, gmail dot com)
14*ed775ee7SAntonio Huete Jimenez */
15*ed775ee7SAntonio Huete Jimenez
16*ed775ee7SAntonio Huete Jimenez /* \summary: Autosar SOME/IP Protocol printer */
17*ed775ee7SAntonio Huete Jimenez
18*ed775ee7SAntonio Huete Jimenez #ifdef HAVE_CONFIG_H
19*ed775ee7SAntonio Huete Jimenez #include <config.h>
20*ed775ee7SAntonio Huete Jimenez #endif
21*ed775ee7SAntonio Huete Jimenez
22*ed775ee7SAntonio Huete Jimenez #include "netdissect-stdinc.h"
23*ed775ee7SAntonio Huete Jimenez #include "netdissect.h"
24*ed775ee7SAntonio Huete Jimenez #include "extract.h"
25*ed775ee7SAntonio Huete Jimenez #include "udp.h"
26*ed775ee7SAntonio Huete Jimenez
27*ed775ee7SAntonio Huete Jimenez /*
28*ed775ee7SAntonio Huete Jimenez * SOMEIP Header (R19-11)
29*ed775ee7SAntonio Huete Jimenez *
30*ed775ee7SAntonio Huete Jimenez * 0 1 2 3
31*ed775ee7SAntonio Huete Jimenez * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
32*ed775ee7SAntonio Huete Jimenez * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
33*ed775ee7SAntonio Huete Jimenez * | Message ID (Service ID/Method ID) |
34*ed775ee7SAntonio Huete Jimenez * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
35*ed775ee7SAntonio Huete Jimenez * | Length |
36*ed775ee7SAntonio Huete Jimenez * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
37*ed775ee7SAntonio Huete Jimenez * | Request ID (Client ID/Session ID) |
38*ed775ee7SAntonio Huete Jimenez * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
39*ed775ee7SAntonio Huete Jimenez * | Protocol Ver | Interface Ver | Message Type | Return Code |
40*ed775ee7SAntonio Huete Jimenez * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
41*ed775ee7SAntonio Huete Jimenez * | Payload |
42*ed775ee7SAntonio Huete Jimenez * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
43*ed775ee7SAntonio Huete Jimenez */
44*ed775ee7SAntonio Huete Jimenez
45*ed775ee7SAntonio Huete Jimenez static const struct tok message_type_values[] = {
46*ed775ee7SAntonio Huete Jimenez { 0x00, "REQUEST" },
47*ed775ee7SAntonio Huete Jimenez { 0x01, "REQUEST_NO_RETURN" },
48*ed775ee7SAntonio Huete Jimenez { 0x02, "NOTIFICATION" },
49*ed775ee7SAntonio Huete Jimenez { 0x80, "RESPONSE" },
50*ed775ee7SAntonio Huete Jimenez { 0x81, "ERROR" },
51*ed775ee7SAntonio Huete Jimenez { 0x20, "TP_REQUEST" },
52*ed775ee7SAntonio Huete Jimenez { 0x21, "TP_REQUEST_NO_RETURN" },
53*ed775ee7SAntonio Huete Jimenez { 0x22, "TP_NOTIFICATION" },
54*ed775ee7SAntonio Huete Jimenez { 0xa0, "TP_RESPONSE" },
55*ed775ee7SAntonio Huete Jimenez { 0xa1, "TP_ERROR" },
56*ed775ee7SAntonio Huete Jimenez { 0, NULL }
57*ed775ee7SAntonio Huete Jimenez };
58*ed775ee7SAntonio Huete Jimenez
59*ed775ee7SAntonio Huete Jimenez static const struct tok return_code_values[] = {
60*ed775ee7SAntonio Huete Jimenez { 0x00, "E_OK" },
61*ed775ee7SAntonio Huete Jimenez { 0x01, "E_NOT_OK" },
62*ed775ee7SAntonio Huete Jimenez { 0x02, "E_UNKNOWN_SERVICE" },
63*ed775ee7SAntonio Huete Jimenez { 0x03, "E_UNKNOWN_METHOD" },
64*ed775ee7SAntonio Huete Jimenez { 0x04, "E_NOT_READY" },
65*ed775ee7SAntonio Huete Jimenez { 0x05, "E_NOT_REACHABLE" },
66*ed775ee7SAntonio Huete Jimenez { 0x06, "E_TIMEOUT" },
67*ed775ee7SAntonio Huete Jimenez { 0x07, "E_WRONG_PROTOCOL_VERSION" },
68*ed775ee7SAntonio Huete Jimenez { 0x08, "E_WRONG_INTERFACE_VERSION" },
69*ed775ee7SAntonio Huete Jimenez { 0x09, "E_MALFORMED_MESSAGE" },
70*ed775ee7SAntonio Huete Jimenez { 0x0a, "E_WRONG_MESSAGE_TYPE" },
71*ed775ee7SAntonio Huete Jimenez { 0x0b, "E_E2E_REPEATED" },
72*ed775ee7SAntonio Huete Jimenez { 0x0c, "E_E2E_WRONG_SEQUENCE" },
73*ed775ee7SAntonio Huete Jimenez { 0x0d, "E_E2E" },
74*ed775ee7SAntonio Huete Jimenez { 0x0e, "E_E2E_NOT_AVAILABLE" },
75*ed775ee7SAntonio Huete Jimenez { 0x0f, "E_E2E_NO_NEW_DATA" },
76*ed775ee7SAntonio Huete Jimenez { 0, NULL }
77*ed775ee7SAntonio Huete Jimenez };
78*ed775ee7SAntonio Huete Jimenez
79*ed775ee7SAntonio Huete Jimenez void
someip_print(netdissect_options * ndo,const u_char * bp,const u_int len)80*ed775ee7SAntonio Huete Jimenez someip_print(netdissect_options *ndo, const u_char *bp, const u_int len)
81*ed775ee7SAntonio Huete Jimenez {
82*ed775ee7SAntonio Huete Jimenez uint32_t message_id;
83*ed775ee7SAntonio Huete Jimenez uint16_t service_id;
84*ed775ee7SAntonio Huete Jimenez uint16_t method_or_event_id;
85*ed775ee7SAntonio Huete Jimenez uint8_t event_flag;
86*ed775ee7SAntonio Huete Jimenez uint32_t message_len;
87*ed775ee7SAntonio Huete Jimenez uint32_t request_id;
88*ed775ee7SAntonio Huete Jimenez uint16_t client_id;
89*ed775ee7SAntonio Huete Jimenez uint16_t session_id;
90*ed775ee7SAntonio Huete Jimenez uint8_t protocol_version;
91*ed775ee7SAntonio Huete Jimenez uint8_t interface_version;
92*ed775ee7SAntonio Huete Jimenez uint8_t message_type;
93*ed775ee7SAntonio Huete Jimenez uint8_t return_code;
94*ed775ee7SAntonio Huete Jimenez
95*ed775ee7SAntonio Huete Jimenez ndo->ndo_protocol = "someip";
96*ed775ee7SAntonio Huete Jimenez nd_print_protocol_caps(ndo);
97*ed775ee7SAntonio Huete Jimenez
98*ed775ee7SAntonio Huete Jimenez if (len < 16) {
99*ed775ee7SAntonio Huete Jimenez goto invalid;
100*ed775ee7SAntonio Huete Jimenez }
101*ed775ee7SAntonio Huete Jimenez
102*ed775ee7SAntonio Huete Jimenez message_id = GET_BE_U_4(bp);
103*ed775ee7SAntonio Huete Jimenez service_id = message_id >> 16;
104*ed775ee7SAntonio Huete Jimenez event_flag = (message_id & 0x00008000) >> 15;
105*ed775ee7SAntonio Huete Jimenez method_or_event_id = message_id & 0x00007FFF;
106*ed775ee7SAntonio Huete Jimenez bp += 4;
107*ed775ee7SAntonio Huete Jimenez ND_PRINT(", service %u, %s %u",
108*ed775ee7SAntonio Huete Jimenez service_id, event_flag ? "event" : "method", method_or_event_id);
109*ed775ee7SAntonio Huete Jimenez
110*ed775ee7SAntonio Huete Jimenez message_len = GET_BE_U_4(bp);
111*ed775ee7SAntonio Huete Jimenez bp += 4;
112*ed775ee7SAntonio Huete Jimenez ND_PRINT(", len %u", message_len);
113*ed775ee7SAntonio Huete Jimenez
114*ed775ee7SAntonio Huete Jimenez request_id = GET_BE_U_4(bp);
115*ed775ee7SAntonio Huete Jimenez client_id = request_id >> 16;
116*ed775ee7SAntonio Huete Jimenez session_id = request_id & 0x0000FFFF;
117*ed775ee7SAntonio Huete Jimenez bp += 4;
118*ed775ee7SAntonio Huete Jimenez ND_PRINT(", client %u, session %u", client_id, session_id);
119*ed775ee7SAntonio Huete Jimenez
120*ed775ee7SAntonio Huete Jimenez protocol_version = GET_U_1(bp);
121*ed775ee7SAntonio Huete Jimenez bp += 1;
122*ed775ee7SAntonio Huete Jimenez ND_PRINT(", pver %u", protocol_version);
123*ed775ee7SAntonio Huete Jimenez
124*ed775ee7SAntonio Huete Jimenez interface_version = GET_U_1(bp);
125*ed775ee7SAntonio Huete Jimenez bp += 1;
126*ed775ee7SAntonio Huete Jimenez ND_PRINT(", iver %u", interface_version);
127*ed775ee7SAntonio Huete Jimenez
128*ed775ee7SAntonio Huete Jimenez message_type = GET_U_1(bp);
129*ed775ee7SAntonio Huete Jimenez bp += 1;
130*ed775ee7SAntonio Huete Jimenez ND_PRINT(", msgtype %s",
131*ed775ee7SAntonio Huete Jimenez tok2str(message_type_values, "Unknown", message_type));
132*ed775ee7SAntonio Huete Jimenez
133*ed775ee7SAntonio Huete Jimenez return_code = GET_U_1(bp);
134*ed775ee7SAntonio Huete Jimenez bp += 1;
135*ed775ee7SAntonio Huete Jimenez ND_PRINT(", retcode %s\n",
136*ed775ee7SAntonio Huete Jimenez tok2str(return_code_values, "Unknown", return_code));
137*ed775ee7SAntonio Huete Jimenez
138*ed775ee7SAntonio Huete Jimenez return;
139*ed775ee7SAntonio Huete Jimenez
140*ed775ee7SAntonio Huete Jimenez invalid:
141*ed775ee7SAntonio Huete Jimenez nd_print_invalid(ndo);
142*ed775ee7SAntonio Huete Jimenez }
143