blob: 8ff392a9ee69efbe4d04c6cfcf2ba5cd5e4684cb (
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
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
|
/*
* 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;
#ifdef LOG_VOLATILE_DATA
out << "Raw HID packet:" << std::endl;
out << ::nitrokey::misc::hexdump((const char *)(&pod), sizeof pod);
#endif
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 status_translate_device(int status){
auto enum_status = static_cast<proto::NKPro::device_status>(status);
switch (enum_status){
case NKPro::device_status::ok: return "OK";
case NKPro::device_status::busy: return "BUSY";
case NKPro::device_status::error: return "ERROR";
case NKPro::device_status::received_report: return "RECEIVED_REPORT";
}
return std::string("UNKNOWN: ") + std::to_string(status);
}
static std::string to_upper(std::string str){
for (auto & c: str) c = toupper(c);
return str;
}
static std::string status_translate_command(int status){
auto enum_status = static_cast<proto::NKPro::command_status >(status);
switch (enum_status) {
#define p(X) case X: return to_upper(std::string(#X));
p(NKPro::command_status::ok)
p(NKPro::command_status::wrong_CRC)
p(NKPro::command_status::wrong_slot)
p(NKPro::command_status::slot_not_programmed)
p(NKPro::command_status::wrong_password)
p(NKPro::command_status::not_authorized)
p(NKPro::command_status::timestamp_warning)
p(NKPro::command_status::no_name_error)
p(NKPro::command_status::not_supported)
p(NKPro::command_status::unknown_command)
p(NKPro::command_status::AES_dec_failed)
#undef p
}
return std::string("UNKNOWN: ") + std::to_string(status);
}
static std::string dissect(const HIDPacket &pod) {
std::stringstream out;
// FIXME use values from firmware (possibly generate separate
// header automatically)
#ifdef LOG_VOLATILE_DATA
out << "Raw HID packet:" << std::endl;
out << ::nitrokey::misc::hexdump((const char *)(&pod), sizeof pod);
#endif
out << "Device status:\t" << pod.device_status + 0 << " "
<< status_translate_device(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 << " "
<< status_translate_command(pod.last_command_status) << std::endl;
out << "CRC:\t"
<< std::hex << std::setw(2) << std::setfill('0')
<< pod.crc << std::endl;
if((int)pod.command_id == pod.storage_status.command_id){
out << "Storage stick status (where applicable):" << 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
|
