blob: 3b347de9a177032725bcb4a45c8e561c0f9d6e87 (
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
|
/*
* Protocol packet dissection
*/
#ifndef DISSECT_H
#define DISSECT_H
#include <string>
#include <sstream>
#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" << 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;
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<<" "<< cmd[ pod.device_status ] << std::endl;
out << "Command ID:\t" << commandid_to_string((CommandID)(pod.command_id)) << std::endl;
out << "Last command CRC:\t" << pod.last_command_crc << std::endl;
out << "Last command status:\t" << pod.last_command_status + 0<<" "<<status[pod.last_command_status] << std::endl;
out << "CRC:\t" << pod.crc << std::endl;
out << "Payload:" << std::endl;
out << pod.payload.dissect();
return out.str();
}
};
}
}
#endif
|
