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
|
package cz.crcs.ectester.reader;
import cz.crcs.ectester.applet.ECTesterApplet;
import javacard.framework.ISO7816;
import javacard.security.CryptoException;
/**
* Utility class, some byte/hex manipulation, convenient byte[] methods.
*
* @author Petr Svenda petr@svenda.com
* @author Jan Jancar johny@neuromancer.sk
*/
public class Util {
public static short getShort(byte[] array, int offset) {
return (short) (((array[offset] & 0xFF) << 8) | (array[offset + 1] & 0xFF));
}
public static void setShort(byte[] array, int offset, short value) {
array[offset + 1] = (byte) (value & 0xFF);
array[offset] = (byte) ((value >> 8) & 0xFF);
}
public static byte[] hexToBytes(String hex) {
return hexToBytes(hex, true);
}
public static byte[] hexToBytes(String hex, boolean bigEndian) {
StringBuilder sb = new StringBuilder(hex.replace(" ", ""));
if (!bigEndian) {
sb.reverse();
}
int len = sb.length();
if (len % 2 == 1) {
sb.insert(0, "0");
++len;
}
String data = sb.toString();
byte[] result = new byte[len / 2];
for (int i = 0; i < len; i += 2) {
result[i / 2] = (byte) ((Character.digit(data.charAt(i), 16) << 4)
+ (Character.digit(data.charAt(i + 1), 16)));
}
return result;
}
public static String byteToHex(byte data) {
return String.format("%02x", data);
}
public static String bytesToHex(byte[] data) {
return bytesToHex(data, true);
}
public static String bytesToHex(byte[] data, boolean addSpace) {
return bytesToHex(data, 0, data.length, addSpace);
}
public static String bytesToHex(byte[] data, int offset, int len) {
return bytesToHex(data, offset, len, true);
}
public static String bytesToHex(byte[] data, int offset, int len, boolean addSpace) {
StringBuilder buf = new StringBuilder();
for (int i = offset; i < (offset + len); i++) {
buf.append(byteToHex(data[i]));
if (addSpace && i != (offset + len - 1)) {
buf.append(" ");
}
}
return (buf.toString());
}
public static byte[] concatenate(byte[]... arrays) {
int len = 0;
for (byte[] array : arrays) {
if (array == null)
continue;
len += array.length;
}
byte[] out = new byte[len];
int offset = 0;
for (byte[] array : arrays) {
if (array == null || array.length == 0)
continue;
System.arraycopy(array, 0, out, offset, array.length);
offset += array.length;
}
return out;
}
public static String getPrintError(short code) {
if (code == ISO7816.SW_NO_ERROR) {
return "OK\t(0x9000)";
} else {
String codeStr = "unknown";
switch (code) {
case CryptoException.ILLEGAL_VALUE:
codeStr = "ILLEGAL_VALUE";
break;
case CryptoException.UNINITIALIZED_KEY:
codeStr = "UNINITIALIZED_KEY";
break;
case CryptoException.NO_SUCH_ALGORITHM:
codeStr = "NO_SUCH_ALG";
break;
case CryptoException.INVALID_INIT:
codeStr = "INVALID_INIT";
break;
case CryptoException.ILLEGAL_USE:
codeStr = "ILLEGAL_USE";
break;
case ECTesterApplet.SW_SIG_VERIFY_FAIL:
codeStr = "SIG_VERIFY_FAIL";
break;
}
return String.format("fail\t(%s,\t0x%04x)", codeStr, code);
}
}
}
|
