blob: 59e6e9cef940ba22f27185c98ffbda77e642df0a (
plain)
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
|
/*
* Protocol packet dissection
*/
#ifndef DISSECT_H
#define DISSECT_H
#include <string>
#include <sstream>
#include <iomanip>
#include "misc.h"
#include "cxx_semantics.h"
#include "command_id.h"
#include "device_proto.h"
namespace nitrokey {
namespace proto {
template <CommandID id, class HIDPacket>
class QueryDissector : semantics::non_constructible {
public:
static std::string dissect(const HIDPacket &pod) {
std::stringstream out;
out << "Raw HID packet:" << std::endl;
out << ::nitrokey::misc::hexdump((const char *)(&pod), sizeof pod);
out << "Contents:" << std::endl;
out << "Command ID:\t" << commandid_to_string((CommandID)(pod.command_id))
<< std::endl;
out << "CRC:\t"
<< std::hex << std::setw(2) << std::setfill('0')
<< pod.crc << std::endl;
out << "Payload:" << std::endl;
out << pod.payload.dissect();
return out.str();
}
};
template <CommandID id, class HIDPacket>
class ResponseDissector : semantics::non_constructible {
public:
static std::string dissect(const HIDPacket &pod) {
std::stringstream out;
// FIXME use values from firmware (possibly generate separate
// header automatically)
std::string status[4];
status[0] = " STATUS_READY";
status[1] = " STATUS_BUSY";
status[2] = " STATUS_ERROR";
status[3] = " STATUS_RECEIVED_REPORT";
std::string cmd[11];
cmd[0] = " CMD_STATUS_OK";
cmd[1] = " CMD_STATUS_WRONG_CRC";
cmd[2] = " CMD_STATUS_WRONG_SLOT";
cmd[3] = " CMD_STATUS_SLOT_NOT_PROGRAMMED";
cmd[4] = " CMD_STATUS_WRONG_PASSWORD";
cmd[5] = " CMD_STATUS_NOT_AUTHORIZED";
cmd[6] = " CMD_STATUS_TIMESTAMP_WARNING";
cmd[7] = " CMD_STATUS_NO_NAME_ERROR";
cmd[8] = " CMD_STATUS_NOT_SUPPORTED";
cmd[9] = " CMD_STATUS_UNKNOWN_COMMAND";
cmd[10] = " CMD_STATUS_AES_DEC_FAILED";
out << "Raw HID packet:" << std::endl;
out << ::nitrokey::misc::hexdump((const char *)(&pod), sizeof pod);
out << "Device status:\t" << pod.device_status + 0 << " "
<< status[pod.device_status] << std::endl;
out << "Command ID:\t" << commandid_to_string((CommandID)(pod.command_id)) << " hex: " << std::hex << (int)pod.command_id
<< std::endl;
out << "Last command CRC:\t"
<< std::hex << std::setw(2) << std::setfill('0')
<< pod.last_command_crc << std::endl;
out << "Last command status:\t" << pod.last_command_status + 0 << " "
<< cmd[pod.last_command_status] << std::endl;
out << "CRC:\t"
<< std::hex << std::setw(2) << std::setfill('0')
<< pod.crc << std::endl;
out << "Storage stick status:" << std::endl;
#define d(x) out << " "#x": \t"<< std::hex << std::setw(2) \
<< std::setfill('0')<< static_cast<int>(x) << std::endl;
d(pod.storage_status.command_counter);
d(pod.storage_status.command_id);
d(pod.storage_status.device_status);
d(pod.storage_status.progress_bar_value);
#undef d
out << "Payload:" << std::endl;
out << pod.payload.dissect();
return out.str();
}
};
}
}
#endif
|
