Commit | Line | Data |
---|---|---|
04010929 JO |
1 | #include <stdio.h> |
2 | #include <string.h> | |
3 | #include <inttypes.h> | |
4 | #include "event-parse.h" | |
5 | ||
6 | typedef unsigned long sector_t; | |
7 | typedef uint64_t u64; | |
8 | typedef unsigned int u32; | |
9 | ||
10 | /* | |
11 | * SCSI opcodes | |
12 | */ | |
13 | #define TEST_UNIT_READY 0x00 | |
14 | #define REZERO_UNIT 0x01 | |
15 | #define REQUEST_SENSE 0x03 | |
16 | #define FORMAT_UNIT 0x04 | |
17 | #define READ_BLOCK_LIMITS 0x05 | |
18 | #define REASSIGN_BLOCKS 0x07 | |
19 | #define INITIALIZE_ELEMENT_STATUS 0x07 | |
20 | #define READ_6 0x08 | |
21 | #define WRITE_6 0x0a | |
22 | #define SEEK_6 0x0b | |
23 | #define READ_REVERSE 0x0f | |
24 | #define WRITE_FILEMARKS 0x10 | |
25 | #define SPACE 0x11 | |
26 | #define INQUIRY 0x12 | |
27 | #define RECOVER_BUFFERED_DATA 0x14 | |
28 | #define MODE_SELECT 0x15 | |
29 | #define RESERVE 0x16 | |
30 | #define RELEASE 0x17 | |
31 | #define COPY 0x18 | |
32 | #define ERASE 0x19 | |
33 | #define MODE_SENSE 0x1a | |
34 | #define START_STOP 0x1b | |
35 | #define RECEIVE_DIAGNOSTIC 0x1c | |
36 | #define SEND_DIAGNOSTIC 0x1d | |
37 | #define ALLOW_MEDIUM_REMOVAL 0x1e | |
38 | ||
39 | #define READ_FORMAT_CAPACITIES 0x23 | |
40 | #define SET_WINDOW 0x24 | |
41 | #define READ_CAPACITY 0x25 | |
42 | #define READ_10 0x28 | |
43 | #define WRITE_10 0x2a | |
44 | #define SEEK_10 0x2b | |
45 | #define POSITION_TO_ELEMENT 0x2b | |
46 | #define WRITE_VERIFY 0x2e | |
47 | #define VERIFY 0x2f | |
48 | #define SEARCH_HIGH 0x30 | |
49 | #define SEARCH_EQUAL 0x31 | |
50 | #define SEARCH_LOW 0x32 | |
51 | #define SET_LIMITS 0x33 | |
52 | #define PRE_FETCH 0x34 | |
53 | #define READ_POSITION 0x34 | |
54 | #define SYNCHRONIZE_CACHE 0x35 | |
55 | #define LOCK_UNLOCK_CACHE 0x36 | |
56 | #define READ_DEFECT_DATA 0x37 | |
57 | #define MEDIUM_SCAN 0x38 | |
58 | #define COMPARE 0x39 | |
59 | #define COPY_VERIFY 0x3a | |
60 | #define WRITE_BUFFER 0x3b | |
61 | #define READ_BUFFER 0x3c | |
62 | #define UPDATE_BLOCK 0x3d | |
63 | #define READ_LONG 0x3e | |
64 | #define WRITE_LONG 0x3f | |
65 | #define CHANGE_DEFINITION 0x40 | |
66 | #define WRITE_SAME 0x41 | |
67 | #define UNMAP 0x42 | |
68 | #define READ_TOC 0x43 | |
69 | #define READ_HEADER 0x44 | |
70 | #define GET_EVENT_STATUS_NOTIFICATION 0x4a | |
71 | #define LOG_SELECT 0x4c | |
72 | #define LOG_SENSE 0x4d | |
73 | #define XDWRITEREAD_10 0x53 | |
74 | #define MODE_SELECT_10 0x55 | |
75 | #define RESERVE_10 0x56 | |
76 | #define RELEASE_10 0x57 | |
77 | #define MODE_SENSE_10 0x5a | |
78 | #define PERSISTENT_RESERVE_IN 0x5e | |
79 | #define PERSISTENT_RESERVE_OUT 0x5f | |
80 | #define VARIABLE_LENGTH_CMD 0x7f | |
81 | #define REPORT_LUNS 0xa0 | |
82 | #define SECURITY_PROTOCOL_IN 0xa2 | |
83 | #define MAINTENANCE_IN 0xa3 | |
84 | #define MAINTENANCE_OUT 0xa4 | |
85 | #define MOVE_MEDIUM 0xa5 | |
86 | #define EXCHANGE_MEDIUM 0xa6 | |
87 | #define READ_12 0xa8 | |
85686f69 | 88 | #define SERVICE_ACTION_OUT_12 0xa9 |
04010929 | 89 | #define WRITE_12 0xaa |
85686f69 | 90 | #define SERVICE_ACTION_IN_12 0xab |
04010929 JO |
91 | #define WRITE_VERIFY_12 0xae |
92 | #define VERIFY_12 0xaf | |
93 | #define SEARCH_HIGH_12 0xb0 | |
94 | #define SEARCH_EQUAL_12 0xb1 | |
95 | #define SEARCH_LOW_12 0xb2 | |
96 | #define SECURITY_PROTOCOL_OUT 0xb5 | |
97 | #define READ_ELEMENT_STATUS 0xb8 | |
98 | #define SEND_VOLUME_TAG 0xb6 | |
99 | #define WRITE_LONG_2 0xea | |
100 | #define EXTENDED_COPY 0x83 | |
101 | #define RECEIVE_COPY_RESULTS 0x84 | |
102 | #define ACCESS_CONTROL_IN 0x86 | |
103 | #define ACCESS_CONTROL_OUT 0x87 | |
104 | #define READ_16 0x88 | |
105 | #define WRITE_16 0x8a | |
106 | #define READ_ATTRIBUTE 0x8c | |
107 | #define WRITE_ATTRIBUTE 0x8d | |
108 | #define VERIFY_16 0x8f | |
109 | #define SYNCHRONIZE_CACHE_16 0x91 | |
110 | #define WRITE_SAME_16 0x93 | |
85686f69 | 111 | #define SERVICE_ACTION_BIDIRECTIONAL 0x9d |
eb846d9f | 112 | #define SERVICE_ACTION_IN_16 0x9e |
85686f69 | 113 | #define SERVICE_ACTION_OUT_16 0x9f |
04010929 JO |
114 | /* values for service action in */ |
115 | #define SAI_READ_CAPACITY_16 0x10 | |
116 | #define SAI_GET_LBA_STATUS 0x12 | |
117 | /* values for VARIABLE_LENGTH_CMD service action codes | |
118 | * see spc4r17 Section D.3.5, table D.7 and D.8 */ | |
119 | #define VLC_SA_RECEIVE_CREDENTIAL 0x1800 | |
120 | /* values for maintenance in */ | |
121 | #define MI_REPORT_IDENTIFYING_INFORMATION 0x05 | |
122 | #define MI_REPORT_TARGET_PGS 0x0a | |
123 | #define MI_REPORT_ALIASES 0x0b | |
124 | #define MI_REPORT_SUPPORTED_OPERATION_CODES 0x0c | |
125 | #define MI_REPORT_SUPPORTED_TASK_MANAGEMENT_FUNCTIONS 0x0d | |
126 | #define MI_REPORT_PRIORITY 0x0e | |
127 | #define MI_REPORT_TIMESTAMP 0x0f | |
128 | #define MI_MANAGEMENT_PROTOCOL_IN 0x10 | |
129 | /* value for MI_REPORT_TARGET_PGS ext header */ | |
130 | #define MI_EXT_HDR_PARAM_FMT 0x20 | |
131 | /* values for maintenance out */ | |
132 | #define MO_SET_IDENTIFYING_INFORMATION 0x06 | |
133 | #define MO_SET_TARGET_PGS 0x0a | |
134 | #define MO_CHANGE_ALIASES 0x0b | |
135 | #define MO_SET_PRIORITY 0x0e | |
136 | #define MO_SET_TIMESTAMP 0x0f | |
137 | #define MO_MANAGEMENT_PROTOCOL_OUT 0x10 | |
138 | /* values for variable length command */ | |
139 | #define XDREAD_32 0x03 | |
140 | #define XDWRITE_32 0x04 | |
141 | #define XPWRITE_32 0x06 | |
142 | #define XDWRITEREAD_32 0x07 | |
143 | #define READ_32 0x09 | |
144 | #define VERIFY_32 0x0a | |
145 | #define WRITE_32 0x0b | |
146 | #define WRITE_SAME_32 0x0d | |
147 | ||
148 | #define SERVICE_ACTION16(cdb) (cdb[1] & 0x1f) | |
149 | #define SERVICE_ACTION32(cdb) ((cdb[8] << 8) | cdb[9]) | |
150 | ||
151 | static const char * | |
152 | scsi_trace_misc(struct trace_seq *, unsigned char *, int); | |
153 | ||
154 | static const char * | |
155 | scsi_trace_rw6(struct trace_seq *p, unsigned char *cdb, int len) | |
156 | { | |
157 | const char *ret = p->buffer + p->len; | |
158 | sector_t lba = 0, txlen = 0; | |
159 | ||
160 | lba |= ((cdb[1] & 0x1F) << 16); | |
161 | lba |= (cdb[2] << 8); | |
162 | lba |= cdb[3]; | |
163 | txlen = cdb[4]; | |
164 | ||
165 | trace_seq_printf(p, "lba=%llu txlen=%llu", | |
166 | (unsigned long long)lba, (unsigned long long)txlen); | |
167 | trace_seq_putc(p, 0); | |
168 | return ret; | |
169 | } | |
170 | ||
171 | static const char * | |
172 | scsi_trace_rw10(struct trace_seq *p, unsigned char *cdb, int len) | |
173 | { | |
174 | const char *ret = p->buffer + p->len; | |
175 | sector_t lba = 0, txlen = 0; | |
176 | ||
177 | lba |= (cdb[2] << 24); | |
178 | lba |= (cdb[3] << 16); | |
179 | lba |= (cdb[4] << 8); | |
180 | lba |= cdb[5]; | |
181 | txlen |= (cdb[7] << 8); | |
182 | txlen |= cdb[8]; | |
183 | ||
184 | trace_seq_printf(p, "lba=%llu txlen=%llu protect=%u", | |
185 | (unsigned long long)lba, (unsigned long long)txlen, | |
186 | cdb[1] >> 5); | |
187 | ||
188 | if (cdb[0] == WRITE_SAME) | |
189 | trace_seq_printf(p, " unmap=%u", cdb[1] >> 3 & 1); | |
190 | ||
191 | trace_seq_putc(p, 0); | |
192 | return ret; | |
193 | } | |
194 | ||
195 | static const char * | |
196 | scsi_trace_rw12(struct trace_seq *p, unsigned char *cdb, int len) | |
197 | { | |
198 | const char *ret = p->buffer + p->len; | |
199 | sector_t lba = 0, txlen = 0; | |
200 | ||
201 | lba |= (cdb[2] << 24); | |
202 | lba |= (cdb[3] << 16); | |
203 | lba |= (cdb[4] << 8); | |
204 | lba |= cdb[5]; | |
205 | txlen |= (cdb[6] << 24); | |
206 | txlen |= (cdb[7] << 16); | |
207 | txlen |= (cdb[8] << 8); | |
208 | txlen |= cdb[9]; | |
209 | ||
210 | trace_seq_printf(p, "lba=%llu txlen=%llu protect=%u", | |
211 | (unsigned long long)lba, (unsigned long long)txlen, | |
212 | cdb[1] >> 5); | |
213 | trace_seq_putc(p, 0); | |
214 | return ret; | |
215 | } | |
216 | ||
217 | static const char * | |
218 | scsi_trace_rw16(struct trace_seq *p, unsigned char *cdb, int len) | |
219 | { | |
220 | const char *ret = p->buffer + p->len; | |
221 | sector_t lba = 0, txlen = 0; | |
222 | ||
223 | lba |= ((u64)cdb[2] << 56); | |
224 | lba |= ((u64)cdb[3] << 48); | |
225 | lba |= ((u64)cdb[4] << 40); | |
226 | lba |= ((u64)cdb[5] << 32); | |
227 | lba |= (cdb[6] << 24); | |
228 | lba |= (cdb[7] << 16); | |
229 | lba |= (cdb[8] << 8); | |
230 | lba |= cdb[9]; | |
231 | txlen |= (cdb[10] << 24); | |
232 | txlen |= (cdb[11] << 16); | |
233 | txlen |= (cdb[12] << 8); | |
234 | txlen |= cdb[13]; | |
235 | ||
236 | trace_seq_printf(p, "lba=%llu txlen=%llu protect=%u", | |
237 | (unsigned long long)lba, (unsigned long long)txlen, | |
238 | cdb[1] >> 5); | |
239 | ||
240 | if (cdb[0] == WRITE_SAME_16) | |
241 | trace_seq_printf(p, " unmap=%u", cdb[1] >> 3 & 1); | |
242 | ||
243 | trace_seq_putc(p, 0); | |
244 | return ret; | |
245 | } | |
246 | ||
247 | static const char * | |
248 | scsi_trace_rw32(struct trace_seq *p, unsigned char *cdb, int len) | |
249 | { | |
250 | const char *ret = p->buffer + p->len, *cmd; | |
251 | sector_t lba = 0, txlen = 0; | |
252 | u32 ei_lbrt = 0; | |
253 | ||
254 | switch (SERVICE_ACTION32(cdb)) { | |
255 | case READ_32: | |
256 | cmd = "READ"; | |
257 | break; | |
258 | case VERIFY_32: | |
259 | cmd = "VERIFY"; | |
260 | break; | |
261 | case WRITE_32: | |
262 | cmd = "WRITE"; | |
263 | break; | |
264 | case WRITE_SAME_32: | |
265 | cmd = "WRITE_SAME"; | |
266 | break; | |
267 | default: | |
268 | trace_seq_printf(p, "UNKNOWN"); | |
269 | goto out; | |
270 | } | |
271 | ||
272 | lba |= ((u64)cdb[12] << 56); | |
273 | lba |= ((u64)cdb[13] << 48); | |
274 | lba |= ((u64)cdb[14] << 40); | |
275 | lba |= ((u64)cdb[15] << 32); | |
276 | lba |= (cdb[16] << 24); | |
277 | lba |= (cdb[17] << 16); | |
278 | lba |= (cdb[18] << 8); | |
279 | lba |= cdb[19]; | |
280 | ei_lbrt |= (cdb[20] << 24); | |
281 | ei_lbrt |= (cdb[21] << 16); | |
282 | ei_lbrt |= (cdb[22] << 8); | |
283 | ei_lbrt |= cdb[23]; | |
284 | txlen |= (cdb[28] << 24); | |
285 | txlen |= (cdb[29] << 16); | |
286 | txlen |= (cdb[30] << 8); | |
287 | txlen |= cdb[31]; | |
288 | ||
289 | trace_seq_printf(p, "%s_32 lba=%llu txlen=%llu protect=%u ei_lbrt=%u", | |
290 | cmd, (unsigned long long)lba, | |
291 | (unsigned long long)txlen, cdb[10] >> 5, ei_lbrt); | |
292 | ||
293 | if (SERVICE_ACTION32(cdb) == WRITE_SAME_32) | |
294 | trace_seq_printf(p, " unmap=%u", cdb[10] >> 3 & 1); | |
295 | ||
296 | out: | |
297 | trace_seq_putc(p, 0); | |
298 | return ret; | |
299 | } | |
300 | ||
301 | static const char * | |
302 | scsi_trace_unmap(struct trace_seq *p, unsigned char *cdb, int len) | |
303 | { | |
304 | const char *ret = p->buffer + p->len; | |
305 | unsigned int regions = cdb[7] << 8 | cdb[8]; | |
306 | ||
307 | trace_seq_printf(p, "regions=%u", (regions - 8) / 16); | |
308 | trace_seq_putc(p, 0); | |
309 | return ret; | |
310 | } | |
311 | ||
312 | static const char * | |
313 | scsi_trace_service_action_in(struct trace_seq *p, unsigned char *cdb, int len) | |
314 | { | |
315 | const char *ret = p->buffer + p->len, *cmd; | |
316 | sector_t lba = 0; | |
317 | u32 alloc_len = 0; | |
318 | ||
319 | switch (SERVICE_ACTION16(cdb)) { | |
320 | case SAI_READ_CAPACITY_16: | |
321 | cmd = "READ_CAPACITY_16"; | |
322 | break; | |
323 | case SAI_GET_LBA_STATUS: | |
324 | cmd = "GET_LBA_STATUS"; | |
325 | break; | |
326 | default: | |
327 | trace_seq_printf(p, "UNKNOWN"); | |
328 | goto out; | |
329 | } | |
330 | ||
331 | lba |= ((u64)cdb[2] << 56); | |
332 | lba |= ((u64)cdb[3] << 48); | |
333 | lba |= ((u64)cdb[4] << 40); | |
334 | lba |= ((u64)cdb[5] << 32); | |
335 | lba |= (cdb[6] << 24); | |
336 | lba |= (cdb[7] << 16); | |
337 | lba |= (cdb[8] << 8); | |
338 | lba |= cdb[9]; | |
339 | alloc_len |= (cdb[10] << 24); | |
340 | alloc_len |= (cdb[11] << 16); | |
341 | alloc_len |= (cdb[12] << 8); | |
342 | alloc_len |= cdb[13]; | |
343 | ||
344 | trace_seq_printf(p, "%s lba=%llu alloc_len=%u", cmd, | |
345 | (unsigned long long)lba, alloc_len); | |
346 | ||
347 | out: | |
348 | trace_seq_putc(p, 0); | |
349 | return ret; | |
350 | } | |
351 | ||
352 | static const char * | |
353 | scsi_trace_varlen(struct trace_seq *p, unsigned char *cdb, int len) | |
354 | { | |
355 | switch (SERVICE_ACTION32(cdb)) { | |
356 | case READ_32: | |
357 | case VERIFY_32: | |
358 | case WRITE_32: | |
359 | case WRITE_SAME_32: | |
360 | return scsi_trace_rw32(p, cdb, len); | |
361 | default: | |
362 | return scsi_trace_misc(p, cdb, len); | |
363 | } | |
364 | } | |
365 | ||
366 | static const char * | |
367 | scsi_trace_misc(struct trace_seq *p, unsigned char *cdb, int len) | |
368 | { | |
369 | const char *ret = p->buffer + p->len; | |
370 | ||
371 | trace_seq_printf(p, "-"); | |
372 | trace_seq_putc(p, 0); | |
373 | return ret; | |
374 | } | |
375 | ||
376 | const char * | |
377 | scsi_trace_parse_cdb(struct trace_seq *p, unsigned char *cdb, int len) | |
378 | { | |
379 | switch (cdb[0]) { | |
380 | case READ_6: | |
381 | case WRITE_6: | |
382 | return scsi_trace_rw6(p, cdb, len); | |
383 | case READ_10: | |
384 | case VERIFY: | |
385 | case WRITE_10: | |
386 | case WRITE_SAME: | |
387 | return scsi_trace_rw10(p, cdb, len); | |
388 | case READ_12: | |
389 | case VERIFY_12: | |
390 | case WRITE_12: | |
391 | return scsi_trace_rw12(p, cdb, len); | |
392 | case READ_16: | |
393 | case VERIFY_16: | |
394 | case WRITE_16: | |
395 | case WRITE_SAME_16: | |
396 | return scsi_trace_rw16(p, cdb, len); | |
397 | case UNMAP: | |
398 | return scsi_trace_unmap(p, cdb, len); | |
eb846d9f | 399 | case SERVICE_ACTION_IN_16: |
04010929 JO |
400 | return scsi_trace_service_action_in(p, cdb, len); |
401 | case VARIABLE_LENGTH_CMD: | |
402 | return scsi_trace_varlen(p, cdb, len); | |
403 | default: | |
404 | return scsi_trace_misc(p, cdb, len); | |
405 | } | |
406 | } | |
407 | ||
408 | unsigned long long process_scsi_trace_parse_cdb(struct trace_seq *s, | |
409 | unsigned long long *args) | |
410 | { | |
0e9e79a1 | 411 | scsi_trace_parse_cdb(s, (unsigned char *) (unsigned long) args[1], args[2]); |
04010929 JO |
412 | return 0; |
413 | } | |
414 | ||
415 | int PEVENT_PLUGIN_LOADER(struct pevent *pevent) | |
416 | { | |
417 | pevent_register_print_function(pevent, | |
418 | process_scsi_trace_parse_cdb, | |
419 | PEVENT_FUNC_ARG_STRING, | |
420 | "scsi_trace_parse_cdb", | |
421 | PEVENT_FUNC_ARG_PTR, | |
422 | PEVENT_FUNC_ARG_PTR, | |
423 | PEVENT_FUNC_ARG_INT, | |
424 | PEVENT_FUNC_ARG_VOID); | |
425 | return 0; | |
426 | } | |
a157112c NK |
427 | |
428 | void PEVENT_PLUGIN_UNLOADER(struct pevent *pevent) | |
429 | { | |
430 | pevent_unregister_print_function(pevent, process_scsi_trace_parse_cdb, | |
431 | "scsi_trace_parse_cdb"); | |
432 | } |