diff options
author | Amaury Pouly <amaury.pouly@gmail.com> | 2012-11-03 04:21:54 +0100 |
---|---|---|
committer | Amaury Pouly <amaury.pouly@gmail.com> | 2012-11-03 04:25:25 +0100 |
commit | 6d04ed343c76b38b5cd632ff0e0ba472ecade583 (patch) | |
tree | 11c006c309bb70f7e21ba254a6796d662333d1b9 /utils/nwztools/scsitools/scsitool.c | |
parent | 3e1c4926806ca685ab591cb6948fa3aa5014591c (diff) | |
download | rockbox-6d04ed343c76b38b5cd632ff0e0ba472ecade583.tar.gz rockbox-6d04ed343c76b38b5cd632ff0e0ba472ecade583.zip |
scsi_tools: add support for nvp reading
There is a vendor specific command to read the NVP of the device,
including the KAS. The trick is that the data is randomly
scrambled using a so-called para_noise array of random values.
There seems to be a problem when retrieving large entries (>1000
bytes typically) which causes sg_pt do behave strangely.
Change-Id: Iefa6140df78ab9c7dcf7ac34cb1170979123ecd7
Diffstat (limited to 'utils/nwztools/scsitools/scsitool.c')
-rw-r--r-- | utils/nwztools/scsitools/scsitool.c | 202 |
1 files changed, 196 insertions, 6 deletions
diff --git a/utils/nwztools/scsitools/scsitool.c b/utils/nwztools/scsitools/scsitool.c index 6848fb90de..97ecee4370 100644 --- a/utils/nwztools/scsitools/scsitool.c +++ b/utils/nwztools/scsitools/scsitool.c | |||
@@ -35,6 +35,7 @@ | |||
35 | #include <scsi/sg_lib.h> | 35 | #include <scsi/sg_lib.h> |
36 | #include <scsi/sg_pt.h> | 36 | #include <scsi/sg_pt.h> |
37 | #include "misc.h" | 37 | #include "misc.h" |
38 | #include "para_noise.h" | ||
38 | 39 | ||
39 | bool g_debug = false; | 40 | bool g_debug = false; |
40 | bool g_force = false; | 41 | bool g_force = false; |
@@ -151,22 +152,27 @@ int do_scsi(uint8_t *cdb, int cdb_size, unsigned flags, void *sense, int *sense_ | |||
151 | 152 | ||
152 | int do_sense_analysis(int status, uint8_t *sense, int sense_size) | 153 | int do_sense_analysis(int status, uint8_t *sense, int sense_size) |
153 | { | 154 | { |
154 | cprintf_field("Status:", " "); fflush(stdout); | 155 | if(status != GOOD || g_debug) |
155 | sg_print_scsi_status(status); | 156 | { |
156 | cprintf_field("\nSense:", " "); fflush(stdout); | 157 | cprintf_field("Status:", " "); fflush(stdout); |
157 | sg_print_sense(NULL, sense, sense_size, 0); | 158 | sg_print_scsi_status(status); |
159 | cprintf_field("\nSense:", " "); fflush(stdout); | ||
160 | sg_print_sense(NULL, sense, sense_size, 0); | ||
161 | } | ||
158 | if(status == GOOD) | 162 | if(status == GOOD) |
159 | return 0; | 163 | return 0; |
160 | return status; | 164 | return status; |
161 | } | 165 | } |
162 | 166 | ||
163 | int do_dnk_cmd(uint32_t cmd, uint8_t sub_cmd, void *buffer, int *buffer_size) | 167 | int do_dnk_cmd(uint32_t cmd, uint8_t sub_cmd, uint16_t arg, void *buffer, int *buffer_size) |
164 | { | 168 | { |
165 | uint8_t cdb[12] = {0xdd, 0, 0, 0, 0, 0, 0, 0xbc, 0, 0, 0, 0}; | 169 | uint8_t cdb[12] = {0xdd, 0, 0, 0, 0, 0, 0, 0xbc, 0, 0, 0, 0}; |
166 | cdb[10] = cmd; | 170 | cdb[10] = cmd; |
167 | cdb[11] = sub_cmd; | 171 | cdb[11] = sub_cmd; |
168 | cdb[8] = (*buffer_size) >> 8; | 172 | cdb[8] = (*buffer_size) >> 8; |
169 | cdb[9] = (*buffer_size) & 0xff; | 173 | cdb[9] = (*buffer_size) & 0xff; |
174 | cdb[4] = (arg >> 8) & 0xff; | ||
175 | cdb[5] = arg & 0xff; | ||
170 | 176 | ||
171 | uint8_t sense[32]; | 177 | uint8_t sense[32]; |
172 | int sense_size = 32; | 178 | int sense_size = 32; |
@@ -242,7 +248,7 @@ int get_dnk_prop(int argc, char **argv) | |||
242 | 248 | ||
243 | char *buffer = buffer_alloc(prop.size + 1); | 249 | char *buffer = buffer_alloc(prop.size + 1); |
244 | int buffer_size = prop.size; | 250 | int buffer_size = prop.size; |
245 | int ret = do_dnk_cmd(prop.cmd, prop.subcmd, buffer, &buffer_size); | 251 | int ret = do_dnk_cmd(prop.cmd, prop.subcmd, 0, buffer, &buffer_size); |
246 | if(ret) | 252 | if(ret) |
247 | return ret; | 253 | return ret; |
248 | if(buffer_size == 0) | 254 | if(buffer_size == 0) |
@@ -268,6 +274,189 @@ int get_dnk_prop(int argc, char **argv) | |||
268 | return 0; | 274 | return 0; |
269 | } | 275 | } |
270 | 276 | ||
277 | #define NVP_EXACT_LENGTH (1 << 0) | ||
278 | #define NVP_STRING (1 << 1) | ||
279 | #define NVP_UINT32 (1 << 2) | ||
280 | |||
281 | struct nvp_prop_t | ||
282 | { | ||
283 | const char *name; | ||
284 | const char *desc; | ||
285 | uint8_t node; | ||
286 | int size; | ||
287 | unsigned flags; | ||
288 | }; | ||
289 | |||
290 | #define NVP_ENTRY(node, name,desc,size,flag) { name, desc, node, size, flag } | ||
291 | |||
292 | struct nvp_prop_t nvp_prop_list[] = | ||
293 | { | ||
294 | NVP_ENTRY(1, "bti", "boot image", 262144, 0), | ||
295 | NVP_ENTRY(2, "hdi", "hold image", 262144, 0), | ||
296 | NVP_ENTRY(3, "cng", "aad key", 704, 0), | ||
297 | NVP_ENTRY(4, "ser", "serial number", 16, NVP_STRING), | ||
298 | NVP_ENTRY(5, "app", "application parameter", 4096, 0), | ||
299 | NVP_ENTRY(6, "eri", "update error image", 262144, 0), | ||
300 | NVP_ENTRY(7, "dcc", "secure clock", 20, 0), | ||
301 | NVP_ENTRY(8, "mdl", "middleware parameter", 8, 0), | ||
302 | NVP_ENTRY(9, "fup", "firmware update flag", 4, 0), | ||
303 | NVP_ENTRY(10, "bok", "beep ok flag", 4, 0), | ||
304 | NVP_ENTRY(11, "shp", "ship information", 32, 0), | ||
305 | NVP_ENTRY(12, "dba", "aad icv", 160, 0), | ||
306 | NVP_ENTRY(13, "dbv", "empr key", 520, 0), | ||
307 | NVP_ENTRY(14, "tr0", "EKB 0", 16384, 0), | ||
308 | NVP_ENTRY(15, "tr1", "EKB 1", 16384, 0), | ||
309 | NVP_ENTRY(16, "mid", "model id", 64, 0), | ||
310 | NVP_ENTRY(17, "tst", "test mode flag", 4, 0), | ||
311 | NVP_ENTRY(18, "gty", "getty mode flag", 4, 0), | ||
312 | NVP_ENTRY(19, "fui", "update image", 262144, 0), | ||
313 | NVP_ENTRY(20, "lbi", "low battery image", 262144, 0), | ||
314 | NVP_ENTRY(21, "dor", "key mode (debug/release)", 4, 0), | ||
315 | NVP_ENTRY(22, "edw", "quick shutdown flag", 4, 0), | ||
316 | NVP_ENTRY(23, "ubp", "u-boot password", 32, 0), | ||
317 | NVP_ENTRY(24, "syi", "system information", 4, 0), | ||
318 | NVP_ENTRY(25, "exm", "exception monitor mode", 4, 0), | ||
319 | NVP_ENTRY(26, "pcd", "product code", 5, 0), | ||
320 | NVP_ENTRY(27, "btc", "battery calibration", 4, 0), | ||
321 | NVP_ENTRY(28, "rnd", "wmt key", 64, 0), | ||
322 | NVP_ENTRY(29, "ufn", "update file name", 8, 0), | ||
323 | NVP_ENTRY(30, "sdp", "sound driver parameter", 64, 0), | ||
324 | NVP_ENTRY(31, "ncp", "noise cancel driver parameter", 64, 0), | ||
325 | NVP_ENTRY(32, "kas", "key and signature", 64, 0), | ||
326 | NVP_ENTRY(33, "sfi", "starfish id", 64, 0), | ||
327 | NVP_ENTRY(34, "rtc", "rtc alarm", 16, 0), | ||
328 | NVP_ENTRY(35, "bpr", "bluetooth address", 2048, 0), | ||
329 | NVP_ENTRY(36, "e00", "EMPR 0", 1024, 0), | ||
330 | NVP_ENTRY(37, "e01", "EMPR 1", 1024, 0), | ||
331 | NVP_ENTRY(38, "e02", "EMPR 2", 1024, 0), | ||
332 | NVP_ENTRY(39, "e03", "EMPR 3", 1024, 0), | ||
333 | NVP_ENTRY(40, "e04", "EMPR 4", 1024, 0), | ||
334 | NVP_ENTRY(41, "e05", "EMPR 5", 1024, 0), | ||
335 | NVP_ENTRY(42, "e06", "EMPR 6", 1024, 0), | ||
336 | NVP_ENTRY(43, "e07", "EMPR 7", 1024, 0), | ||
337 | NVP_ENTRY(44, "e08", "EMPR 8", 1024, 0), | ||
338 | NVP_ENTRY(45, "e09", "EMPR 9", 1024, 0), | ||
339 | NVP_ENTRY(46, "e10", "EMPR 10", 1024, 0), | ||
340 | NVP_ENTRY(47, "e11", "EMPR 11", 1024, 0), | ||
341 | NVP_ENTRY(48, "e12", "EMPR 12", 1024, 0), | ||
342 | NVP_ENTRY(49, "e13", "EMPR 13", 1024, 0), | ||
343 | NVP_ENTRY(50, "e14", "EMPR 14", 1024, 0), | ||
344 | NVP_ENTRY(51, "e15", "EMPR 15", 1024, 0), | ||
345 | NVP_ENTRY(52, "e16", "EMPR 16", 1024, 0), | ||
346 | NVP_ENTRY(53, "e17", "EMPR 17", 1024, 0), | ||
347 | NVP_ENTRY(54, "e18", "EMPR 18", 1024, 0), | ||
348 | NVP_ENTRY(55, "e19", "EMPR 19", 1024, 0), | ||
349 | NVP_ENTRY(56, "e20", "EMPR 20", 1024, 0), | ||
350 | NVP_ENTRY(57, "e21", "EMPR 21", 1024, 0), | ||
351 | NVP_ENTRY(58, "e22", "EMPR 22", 1024, 0), | ||
352 | NVP_ENTRY(59, "e23", "EMPR 23", 1024, 0), | ||
353 | NVP_ENTRY(60, "e24", "EMPR 24", 1024, 0), | ||
354 | NVP_ENTRY(61, "e25", "EMPR 25", 1024, 0), | ||
355 | NVP_ENTRY(62, "e26", "EMPR 26", 1024, 0), | ||
356 | NVP_ENTRY(63, "e27", "EMPR 27", 1024, 0), | ||
357 | NVP_ENTRY(64, "e28", "EMPR 28", 1024, 0), | ||
358 | NVP_ENTRY(65, "e29", "EMPR 29", 1024, 0), | ||
359 | NVP_ENTRY(66, "e30", "EMPR 30", 1024, 0), | ||
360 | NVP_ENTRY(67, "e31", "EMPR 31", 1024, 0), | ||
361 | NVP_ENTRY(68, "clv", "color variation", 4, 0), | ||
362 | NVP_ENTRY(69, "slp", "time out to sleep", 4, 0), | ||
363 | NVP_ENTRY(70, "ipt", "disable iptable flag", 4, 0), | ||
364 | NVP_ENTRY(71, "mtm", "marlin time", 64, 0), | ||
365 | NVP_ENTRY(72, "mcr", "marlin crl", 16384, 0), | ||
366 | NVP_ENTRY(73, "mdk", "marlin device key", 33024, 0), | ||
367 | NVP_ENTRY(74, "muk", "marlin user key", 24576, 0), | ||
368 | NVP_ENTRY(75, "pts", "wifi protected setup", 4, 0), | ||
369 | NVP_ENTRY(76, "skt", "slacker time", 16, 0), | ||
370 | NVP_ENTRY(77, "mac", "wifi mac address", 6, 0), | ||
371 | NVP_ENTRY(78, "apd", "application debug mode flag", 4, 0), | ||
372 | NVP_ENTRY(79, "blf", "browser log mode flag", 4, 0), | ||
373 | NVP_ENTRY(80, "hld", "hold mode", 4, 0), | ||
374 | NVP_ENTRY(81, "skd", "slacker id file", 8224, 0), | ||
375 | NVP_ENTRY(82, "fmp", "fm parameter", 16, 0), | ||
376 | NVP_ENTRY(83, "sps", "speaker ship info", 4, 0), | ||
377 | NVP_ENTRY(84, "msc", "mass storage class mode", 4, 0), | ||
378 | NVP_ENTRY(85, "vrt", "europe vol regulation flag", 4, 0), | ||
379 | NVP_ENTRY(86, "psk", "bluetooth pskey", 512, 0), | ||
380 | NVP_ENTRY(87, "bml", "btmw log mode flag", 4, 0), | ||
381 | NVP_ENTRY(88, "bfd", "btmw factory scdb", 512, 0), | ||
382 | NVP_ENTRY(89, "bfp", "btmw factory pair info", 512, 0), | ||
383 | }; | ||
384 | |||
385 | #define NR_NVP_PROPS (sizeof(nvp_prop_list) / sizeof(nvp_prop_list[0])) | ||
386 | |||
387 | int get_dnk_nvp(int argc, char **argv) | ||
388 | { | ||
389 | if(argc != 1 && argc != 3) | ||
390 | { | ||
391 | printf("You must specify a known nvp node or a full node specification:\n"); | ||
392 | printf("Full usage: <node> <size> <flags>\n"); | ||
393 | printf("Node usage: <node>\n"); | ||
394 | printf("Nodes:\n"); | ||
395 | for(unsigned i = 0; i < NR_NVP_PROPS; i++) | ||
396 | printf(" %s\t%s", nvp_prop_list[i].name, nvp_prop_list[i].desc); | ||
397 | printf("\n"); | ||
398 | return 1; | ||
399 | } | ||
400 | |||
401 | struct nvp_prop_t prop; | ||
402 | memset(&prop, 0, sizeof(prop)); | ||
403 | if(argc == 1) | ||
404 | { | ||
405 | for(unsigned i = 0; i < NR_NVP_PROPS; i++) | ||
406 | if(strcmp(nvp_prop_list[i].name, argv[0]) == 0) | ||
407 | prop = nvp_prop_list[i]; | ||
408 | if(prop.name == NULL) | ||
409 | { | ||
410 | cprintf(GREY, "Unknown node '%s'\n", argv[0]); | ||
411 | return 1; | ||
412 | } | ||
413 | } | ||
414 | else | ||
415 | { | ||
416 | prop.node = strtoul(argv[0], NULL, 0); | ||
417 | prop.size = strtoul(argv[1], NULL, 0); | ||
418 | prop.flags = strtoul(argv[2], NULL, 0); | ||
419 | } | ||
420 | |||
421 | int buffer_size = prop.size + 4; | ||
422 | uint8_t *buffer = buffer_alloc(buffer_size + 1); | ||
423 | int ret = do_dnk_cmd(0x23, 10, prop.node, buffer, &buffer_size); | ||
424 | if(ret) | ||
425 | return ret; | ||
426 | if(buffer_size <= 4) | ||
427 | { | ||
428 | cprintf(GREY, "Device didn't send any data\n"); | ||
429 | return 1; | ||
430 | } | ||
431 | if(buffer[0] != 0 || buffer[2] != 0 || buffer[3] != prop.node) | ||
432 | { | ||
433 | cprintf(GREY, "Device responded with invalid data\n"); | ||
434 | return 1; | ||
435 | } | ||
436 | |||
437 | for(int i = 4, idx = buffer[1]; i < buffer_size; i++, idx++) | ||
438 | buffer[i] ^= para_noise[idx]; | ||
439 | buffer[buffer_size] = 0; | ||
440 | buffer += 4; | ||
441 | buffer_size -= 4; | ||
442 | if((prop.flags & DNK_EXACT_LENGTH) && buffer_size != prop.size) | ||
443 | { | ||
444 | cprintf(GREY, "Device didn't send the expected amount of data\n"); | ||
445 | return 2; | ||
446 | } | ||
447 | |||
448 | if(prop.flags & DNK_STRING) | ||
449 | cprintf_field("Node: ", "%s\n", buffer); | ||
450 | else if(prop.flags & DNK_UINT32) | ||
451 | cprintf_field("Node: ", "0x%x\n", *(uint32_t *)buffer); | ||
452 | else | ||
453 | { | ||
454 | cprintf(GREEN, "Node:\n"); | ||
455 | print_hex(buffer, buffer_size); | ||
456 | } | ||
457 | return 0; | ||
458 | } | ||
459 | |||
271 | struct dpcc_prop_t | 460 | struct dpcc_prop_t |
272 | { | 461 | { |
273 | char *user_name; | 462 | char *user_name; |
@@ -419,6 +608,7 @@ struct cmd_t | |||
419 | struct cmd_t cmd_list[] = | 608 | struct cmd_t cmd_list[] = |
420 | { | 609 | { |
421 | { "get_dnk_prop", "Get DNK property", get_dnk_prop }, | 610 | { "get_dnk_prop", "Get DNK property", get_dnk_prop }, |
611 | { "get_dnk_nvp", "Get DNK NVP content", get_dnk_nvp }, | ||
422 | { "get_dpcc_prop", "Get DPCC property", get_dpcc_prop }, | 612 | { "get_dpcc_prop", "Get DPCC property", get_dpcc_prop }, |
423 | { "get_user_time", "Get user time", get_user_time }, | 613 | { "get_user_time", "Get user time", get_user_time }, |
424 | { "get_dev_info", "Get device info", get_dev_info }, | 614 | { "get_dev_info", "Get device info", get_dev_info }, |