cvs.zerfleddert.de Git - proxmark3-svn/blob

1 //-----------------------------------------------------------------------------

3 //

4 // This code is licensed to you under the terms of the GNU GPL, version 2 or,

5 // at your option, any later version. See the LICENSE.txt file for the text of

6 // the license.

7 //-----------------------------------------------------------------------------

8 // Commands related to the German electronic Identification Card

9 //-----------------------------------------------------------------------------

11 #include "util.h"

13 #include "proxmark3.h"

14 #include "ui.h"

15 #include "cmdparser.h"

16 #include "common.h"

17 #include "cmdmain.h"

18 #include "sleep.h"

19 #include "cmdhfepa.h"

 static int CmdHelp(const char *Cmd);

23 // Perform (part of) the PACE protocol

 int CmdHFEPACollectPACENonces(const char *Cmd)

25 {

26 // requested nonce size

27 unsigned int m = 0;

28 // requested number of Nonces

29 unsigned int n = 0;

30 // delay between requests

31 unsigned int d = 0;

         sscanf(Cmd, "%u %u %u", &m, &n, &d);

35 // values are expected to be > 0

         m = m > 0 ? m : 1;

         n = n > 0 ? n : 1;

         PrintAndLog("Collecting %u %"hhu"-byte nonces", n, m);

         PrintAndLog("Start: %u", time(NULL));

41 // repeat n times

         for (unsigned int i = 0; i < n; i++) {

43 // execute PACE

                 UsbCommand c = {CMD_EPA_PACE_COLLECT_NONCE, {(int)m, 0, 0}};

45 SendCommand(&c);

46 UsbCommand resp;

48 WaitForResponse(CMD_ACK,&resp);

50 // check if command failed

                 if (resp.arg[0] != 0) {

                         PrintAndLog("Error in step %d, Return code: %d",resp.arg[0],(int)resp.arg[1]);

53 } else {

                         size_t nonce_length = resp.arg[1];

                         char *nonce = (char *) malloc(2 * nonce_length + 1);

                         for(int j = 0; j < nonce_length; j++) {

                                 sprintf(nonce + (2 * j), "%02X", resp.d.asBytes[j]);

58 }

59 // print nonce

                         PrintAndLog("Length: %d, Nonce: %s", nonce_length, nonce);

61 free(nonce);

62 }

                 if (i < n - 1) {

64 sleep(d);

65 }

66 }

         PrintAndLog("End: %u", time(NULL));

69 return 1;

70 }

72 ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////

73 ////////////////////////////////The commands lie below here/////////////////////////////////////////////////////////////////////////////////////////

75 // perform the PACE protocol by replaying APDUs

 int CmdHFEPAPACEReplay(const char *Cmd)

77 {

78 // the 4 APDUs which are replayed + their lengths

         uint8_t msesa_apdu[41], gn_apdu[8], map_apdu[75];

         uint8_t pka_apdu[75], ma_apdu[18], apdu_lengths[5] = {0};

81 // pointers to the arrays to be able to iterate

         uint8_t *apdus[] = {msesa_apdu, gn_apdu, map_apdu, pka_apdu, ma_apdu};

84 // usage message

85 static const char const *usage_msg =

86 "Please specify 5 APDUs separated by spaces. "

87 "Example:\n preplay 0022C1A4 1068000000 1086000002 1234ABCDEF 1A2B3C4D";

89 // Proxmark response

90 UsbCommand resp;

         int skip = 0, skip_add = 0, scan_return = 0;

93 // for each APDU

         for (int i = 0; i < sizeof(apdu_lengths); i++) {

95 // scan to next space or end of string

                 while (Cmd[skip] != ' ' && Cmd[skip] != '\0') {

97 // convert

                         scan_return = sscanf(Cmd + skip, "%2X%n",

                                              (unsigned int *) (apdus[i] + apdu_lengths[i]),

100 &skip_add);

                         if (scan_return < 1) {

                                 PrintAndLog((char *)usage_msg);

103 PrintAndLog("Not enough APDUs! Try again!");

104 return 0;

105 }

106 skip += skip_add;

107 apdu_lengths[i]++;

108 }

109

110 // break on EOF

                 if (Cmd[skip] == '\0') {

                         if (i < sizeof(apdu_lengths) - 1) {

113

                                 PrintAndLog((char *)usage_msg);

115 return 0;

116 }

117 break;

118 }

119 // skip the space

120 skip++;

121 }

122

123 // transfer the APDUs to the Proxmark

124 UsbCommand usb_cmd;

125 usb_cmd.cmd = CMD_EPA_PACE_REPLAY;

         for (int i = 0; i < sizeof(apdu_lengths); i++) {

127 // APDU number

                 usb_cmd.arg[0] = i + 1;

129 // transfer the APDU in several parts if necessary

                 for (int j = 0; j * sizeof(usb_cmd.d.asBytes) < apdu_lengths[i]; j++) {

131 // offset into the APDU

                         usb_cmd.arg[1] = j * sizeof(usb_cmd.d.asBytes);

133 // amount of data in this packet

                         int packet_length = apdu_lengths[i] - (j * sizeof(usb_cmd.d.asBytes));

                         if (packet_length > sizeof(usb_cmd.d.asBytes)) {

                                 packet_length = sizeof(usb_cmd.d.asBytes);

137 }

                         usb_cmd.arg[2] = packet_length;

139

                         memcpy(usb_cmd.d.asBytes, // + (j * sizeof(usb_cmd.d.asBytes)),

                                apdus[i] + (j * sizeof(usb_cmd.d.asBytes)),

142 packet_length);

143 SendCommand(&usb_cmd);

144 WaitForResponse(CMD_ACK, &resp);

                         if (resp.arg[0] != 0) {

                                 PrintAndLog("Transfer of APDU #%d Part %d failed!", i, j);

147 return 0;

148 }

149 }

150 }

151

152 // now perform the replay

         usb_cmd.arg[0] = 0;

154 SendCommand(&usb_cmd);

155 WaitForResponse(CMD_ACK, &resp);

         if (resp.arg[0] != 0) {

                 PrintAndLog("\nPACE replay failed in step %u!", (uint32_t)resp.arg[0]);

158 PrintAndLog("Measured times:");

                 PrintAndLog("MSE Set AT: %u us", resp.d.asDwords[0]);

                 PrintAndLog("GA Get Nonce: %u us", resp.d.asDwords[1]);

                 PrintAndLog("GA Map Nonce: %u us", resp.d.asDwords[2]);

                 PrintAndLog("GA Perform Key Agreement: %u us", resp.d.asDwords[3]);

                 PrintAndLog("GA Mutual Authenticate: %u us", resp.d.asDwords[4]);

164 } else {

165 PrintAndLog("PACE replay successfull!");

                 PrintAndLog("MSE Set AT: %u us", resp.d.asDwords[0]);

                 PrintAndLog("GA Get Nonce: %u us", resp.d.asDwords[1]);

                 PrintAndLog("GA Map Nonce: %u us", resp.d.asDwords[2]);

                 PrintAndLog("GA Perform Key Agreement: %u us", resp.d.asDwords[3]);

                 PrintAndLog("GA Mutual Authenticate: %u us", resp.d.asDwords[4]);

171 }

172

173

174 return 1;

175 }

176

177 ////////////////////////////////The new commands lie above here/////////////////////////////////////////////////////////////////////////////////////

178 ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////

179

180 // UI-related stuff

181

182 static const command_t CommandTable[] =

183 {

   {"help",    CmdHelp,                   1, "This help"},

   {"cnonces", CmdHFEPACollectPACENonces, 0,

186 "<m> <n> <d> Acquire n>0 encrypted PACE nonces of size m>0 with d sec pauses"},

   {"preplay", CmdHFEPAPACEReplay,        0,

188 "<mse> <get> <map> <pka> <ma> Perform PACE protocol by replaying given APDUs"},

   {NULL, NULL, 0, NULL}

190 };

191

 int CmdHelp(const char *Cmd)

193 {

194 CmdsHelp(CommandTable);

195 return 0;

196 }

197

 int CmdHFEPA(const char *Cmd)

199 {

200 // flush

         WaitForResponseTimeout(CMD_ACK,NULL,100);

202

203 // parse

204 CmdsParse(CommandTable, Cmd);

205 return 0;

206 }