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