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
use std::fmt;
pub const APDU_HEADER_SIZE: usize = 0x05;
#[repr(packed)]
pub struct APDU {
pub cla: u8,
pub ins: u8,
pub p1: u8,
pub p2: u8,
pub len: u8,
pub data: Vec<u8>,
}
impl fmt::Debug for APDU {
fn fmt(&self, f: &mut fmt::Formatter) -> fmt::Result {
let d = vec![].clone_from(&self.data);
write!(
f,
"APDU {{ cla: {}, ins: {}, p1: {}, p2: {}, len: {}, data: {:?} }}",
self.cla, self.ins, self.p1, self.p2, self.len, d
)
}
}
impl Clone for APDU {
fn clone(&self) -> APDU {
APDU {
cla: self.cla,
ins: self.ins,
p1: self.p1,
p2: self.p2,
len: self.len,
data: self.data.clone(),
}
}
}
impl Default for APDU {
fn default() -> Self {
APDU {
cla: 0xe0,
ins: 0x00,
p1: 0x00,
p2: 0x00,
len: 0x00,
data: Vec::new(),
}
}
}
impl APDU {
pub fn raw_header(&self) -> Vec<u8> {
let mut buf = Vec::with_capacity(APDU_HEADER_SIZE);
buf.push(self.cla);
buf.push(self.ins);
buf.push(self.p1);
buf.push(self.p2);
buf.push(self.len);
buf
}
pub fn len(&self) -> usize {
let len = self.data.len();
len + APDU_HEADER_SIZE
}
}
pub struct ApduBuilder {
apdu: APDU,
}
#[allow(dead_code)]
impl ApduBuilder {
pub fn new(cmd: u8) -> Self {
let mut apdu = APDU::default();
apdu.ins = cmd;
Self { apdu }
}
pub fn with_p1(&mut self, p1: u8) -> &mut Self {
self.apdu.p1 = p1;
self
}
pub fn with_p2(&mut self, p2: u8) -> &mut Self {
self.apdu.p2 = p2;
self
}
pub fn with_data(&mut self, data: &[u8]) -> &mut Self {
self.apdu.data.extend_from_slice(data);
self.apdu.len += data.len() as u8;
self
}
pub fn build(&self) -> APDU {
self.apdu.clone()
}
}