David Jung / Mbed OS MAX86140_Authenication_SHA256_test

intiial commit

Dependencies:   MAX8614X USBDevice max32630hsp_test

main.cpp@13:97854f761347, 2018-08-16 (annotated)

Committer:
phonemacro
Date:
Thu Aug 16 21:06:58 2018 +0000
Revision:
13:97854f761347
Parent:
12:fc888315e5fd
Child:
14:1939758a03cf
challenge 2 no rom id added

Who changed what in which revision?

UserRevisionLine numberNew contents of line
phonemacro 0:9e5a4f845510 1 /**********************************************************************
phonemacro 1:854f8a89a527 2 * Copyright (C) 2018 Maxim Integrated Products, Inc., All Rights Reserved.
phonemacro 0:9e5a4f845510 3 *
phonemacro 0:9e5a4f845510 4 * Permission is hereby granted, free of charge, to any person obtaining a
phonemacro 0:9e5a4f845510 5 * copy of this software and associated documentation files (the "Software"),
phonemacro 0:9e5a4f845510 6 * to deal in the Software without restriction, including without limitation
phonemacro 0:9e5a4f845510 7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
phonemacro 0:9e5a4f845510 8 * and/or sell copies of the Software, and to permit persons to whom the
phonemacro 0:9e5a4f845510 9 * Software is furnished to do so, subject to the following conditions:
phonemacro 0:9e5a4f845510 10 *
phonemacro 0:9e5a4f845510 11 * The above copyright notice and this permission notice shall be included
phonemacro 0:9e5a4f845510 12 * in all copies or substantial portions of the Software.
phonemacro 0:9e5a4f845510 13 *
phonemacro 0:9e5a4f845510 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
phonemacro 0:9e5a4f845510 15 * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
phonemacro 0:9e5a4f845510 16 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
phonemacro 0:9e5a4f845510 17 * IN NO EVENT SHALL MAXIM INTEGRATED BE LIABLE FOR ANY CLAIM, DAMAGES
phonemacro 0:9e5a4f845510 18 * OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
phonemacro 0:9e5a4f845510 19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
phonemacro 0:9e5a4f845510 20 * OTHER DEALINGS IN THE SOFTWARE.
phonemacro 0:9e5a4f845510 21 *
phonemacro 0:9e5a4f845510 22 * Except as contained in this notice, the name of Maxim Integrated
phonemacro 0:9e5a4f845510 23 * Products, Inc. shall not be used except as stated in the Maxim Integrated
phonemacro 0:9e5a4f845510 24 * Products, Inc. Branding Policy.
phonemacro 0:9e5a4f845510 25 *
phonemacro 0:9e5a4f845510 26 * The mere transfer of this software does not imply any licenses
phonemacro 0:9e5a4f845510 27 * of trade secrets, proprietary technology, copyrights, patents,
phonemacro 0:9e5a4f845510 28 * trademarks, maskwork rights, or any other form of intellectual
phonemacro 0:9e5a4f845510 29 * property whatsoever. Maxim Integrated Products, Inc. retains all
phonemacro 0:9e5a4f845510 30 * ownership rights.
phonemacro 0:9e5a4f845510 31 **********************************************************************/
phonemacro 0:9e5a4f845510 32
phonemacro 0:9e5a4f845510 33
phonemacro 0:9e5a4f845510 34 #include "mbed.h"
phonemacro 0:9e5a4f845510 35 //#include "max32630fthr.h"
phonemacro 0:9e5a4f845510 36 #include "max32630hsp.h"
phonemacro 0:9e5a4f845510 37 #include "MAX8614X.h"
phonemacro 0:9e5a4f845510 38 #include "USBSerial.h"
phonemacro 12:fc888315e5fd 39 void executeSha256(MAX8614X &m, uint8_t *challenge, unsigned int challengeLen, bool romID);
phonemacro 7:5b7f7ec9efe0 40
phonemacro 0:9e5a4f845510 41
phonemacro 0:9e5a4f845510 42 MAX32630HSP icarus(MAX32630HSP::VIO_1V8);
phonemacro 0:9e5a4f845510 43 // MAX32630FTHR mbed_board(MAX32630FTHR::VIO_1V8);
phonemacro 0:9e5a4f845510 44 SPI spi(P5_1, P5_2, P5_0); /* mosi, miso, sclk */
phonemacro 3:2272f89aad7e 45 //DigitalOut cs(P3_0);
phonemacro 3:2272f89aad7e 46 DigitalOut cs(P5_3);
phonemacro 6:0ec9dd0e8eb0 47 //PinName interrupt_pin = P3_3;
phonemacro 6:0ec9dd0e8eb0 48 //PinnName interrupt_pin = P5_7;
phonemacro 6:0ec9dd0e8eb0 49 //PinName interrupt_pin = P5_5;
phonemacro 6:0ec9dd0e8eb0 50 //PinName interrupt_pin = P3_6;
phonemacro 6:0ec9dd0e8eb0 51 //PinName interrupt_pin = P3_7;
phonemacro 6:0ec9dd0e8eb0 52 //PinName interrupt_pin = P3_2;
phonemacro 6:0ec9dd0e8eb0 53 PinName interrupt_pin = P5_4;
phonemacro 0:9e5a4f845510 54 // Virtual serial port over USB
phonemacro 0:9e5a4f845510 55 USBSerial microUSB;
phonemacro 0:9e5a4f845510 56
phonemacro 0:9e5a4f845510 57 DigitalOut rLED(LED1);
phonemacro 0:9e5a4f845510 58 DigitalOut gLED(LED2);
phonemacro 0:9e5a4f845510 59 DigitalOut bLED(LED3);
phonemacro 0:9e5a4f845510 60 int main()
phonemacro 0:9e5a4f845510 61 {
phonemacro 7:5b7f7ec9efe0 62 #define CHALLENGE_SZ_NO_SECRET 20
phonemacro 10:0b940aff3bb8 63 uint8_t challenge_1[CHALLENGE_SZ_NO_SECRET] = { // 160 bit
phonemacro 10:0b940aff3bb8 64 0x5e, 0x81, 0x35, 0x24,
phonemacro 10:0b940aff3bb8 65 0x56, 0x63, 0xd6, 0x09,
phonemacro 10:0b940aff3bb8 66 0x99, 0x8d, 0x7b, 0x0d,
phonemacro 10:0b940aff3bb8 67 0x52, 0x12, 0x84, 0x65,
phonemacro 10:0b940aff3bb8 68 0xcd, 0x0d, 0xe3, 0x01
phonemacro 4:46919eec2c28 69 };
phonemacro 4:46919eec2c28 70
phonemacro 13:97854f761347 71 uint8_t challenge_2[CHALLENGE_SZ_NO_SECRET] = { // 160 bit
phonemacro 13:97854f761347 72 0xd2, 0xaa, 0x84, 0xc5,
phonemacro 13:97854f761347 73 0x72, 0x77, 0xf7, 0xe5,
phonemacro 13:97854f761347 74 0xdb, 0x8f, 0xd6, 0x12,
phonemacro 13:97854f761347 75 0x96, 0xce, 0x69, 0xf2,
phonemacro 13:97854f761347 76 0x4e, 0xc5, 0x7a, 0xe8
phonemacro 13:97854f761347 77 };
phonemacro 5:df9f75bee8ac 78 #define MAC_SZ 32
phonemacro 7:5b7f7ec9efe0 79
phonemacro 0:9e5a4f845510 80
phonemacro 0:9e5a4f845510 81 // daplink.printf("daplink serial port\r\n");
phonemacro 0:9e5a4f845510 82 // microUSB.printf("micro USB serial port\r\n");
phonemacro 0:9e5a4f845510 83 rLED = LED_ON;
phonemacro 0:9e5a4f845510 84 gLED = LED_ON;
phonemacro 0:9e5a4f845510 85 bLED = LED_OFF;
phonemacro 0:9e5a4f845510 86
phonemacro 0:9e5a4f845510 87 rLED = LED_OFF;
phonemacro 1:854f8a89a527 88 printf("\r\n\rmax86140 authenication software\r\n");
phonemacro 11:ec7998257ec2 89 MAX8614X m(spi,cs,interrupt_pin);
phonemacro 11:ec7998257ec2 90 // MAX8614X m(spi,cs,interrupt_pin);
phonemacro 7:5b7f7ec9efe0 91 // m.readRegister(MAX8614X::MAX8614X_PART_ID_REG, data, 1);
phonemacro 7:5b7f7ec9efe0 92 // printf("device id should be 0x24, reg %02X = %02X\r\n", MAX8614X::MAX8614X_PART_ID_REG, data[0]);
phonemacro 3:2272f89aad7e 93
phonemacro 12:fc888315e5fd 94 executeSha256(m, challenge_1, CHALLENGE_SZ_NO_SECRET, 1);
phonemacro 13:97854f761347 95 executeSha256(m, challenge_2, CHALLENGE_SZ_NO_SECRET, 1);
phonemacro 13:97854f761347 96 executeSha256(m, challenge_2, CHALLENGE_SZ_NO_SECRET, 0);
phonemacro 13:97854f761347 97 //- Compare MAC from MAX86140 wth Host's precalculated MAC.
phonemacro 13:97854f761347 98 //- Check PASS or FAIL.
phonemacro 13:97854f761347 99 //- Disable SHA_EN bit ( Write 0 to SHA_EN bit).
phonemacro 0:9e5a4f845510 100 while(1) {
phonemacro 1:854f8a89a527 101 gLED = !gLED;
phonemacro 0:9e5a4f845510 102 wait(1.0);
phonemacro 0:9e5a4f845510 103 }
phonemacro 0:9e5a4f845510 104 }
phonemacro 0:9e5a4f845510 105
phonemacro 10:0b940aff3bb8 106 #if 0
phonemacro 7:5b7f7ec9efe0 107 void transformData(uint8_t *inData, uint8_t *outData, unsigned int challengeLen)
phonemacro 7:5b7f7ec9efe0 108 {
phonemacro 7:5b7f7ec9efe0 109 int i, j, k;
phonemacro 7:5b7f7ec9efe0 110 k = 0;
phonemacro 7:5b7f7ec9efe0 111 for (i = 0; i < (challengeLen/4); i++) {
phonemacro 7:5b7f7ec9efe0 112 for (j = 3; j >= 0; j--) {
phonemacro 7:5b7f7ec9efe0 113 outData[j+(i*4)] = inData[k];
phonemacro 7:5b7f7ec9efe0 114 k++;
phonemacro 7:5b7f7ec9efe0 115 }
phonemacro 7:5b7f7ec9efe0 116 }
phonemacro 7:5b7f7ec9efe0 117 }
phonemacro 10:0b940aff3bb8 118 #endif
phonemacro 10:0b940aff3bb8 119 void transformData(uint8_t *inData, uint8_t *outData, unsigned int challengeLen)
phonemacro 10:0b940aff3bb8 120 {
phonemacro 10:0b940aff3bb8 121 int i, j, k;
phonemacro 10:0b940aff3bb8 122 k = 0;
phonemacro 10:0b940aff3bb8 123 for (i = 0; i < (challengeLen/4); i++) {
phonemacro 10:0b940aff3bb8 124 for (j = 3; j >= 0; j--) {
phonemacro 10:0b940aff3bb8 125 outData[j+(i*4)] = inData[k];
phonemacro 10:0b940aff3bb8 126 // printf("%02X ",inData[k]);
phonemacro 10:0b940aff3bb8 127 k++;
phonemacro 10:0b940aff3bb8 128 }
phonemacro 10:0b940aff3bb8 129 // printf("\r\n");
phonemacro 10:0b940aff3bb8 130 }
phonemacro 10:0b940aff3bb8 131 for (i=0; i < challengeLen; i++) {
phonemacro 10:0b940aff3bb8 132 // if (!(i % 4))
phonemacro 10:0b940aff3bb8 133 // printf("\r\n ");
phonemacro 10:0b940aff3bb8 134 // printf("%02X ",outData[i]);
phonemacro 10:0b940aff3bb8 135 }
phonemacro 10:0b940aff3bb8 136 }
phonemacro 7:5b7f7ec9efe0 137
phonemacro 7:5b7f7ec9efe0 138
phonemacro 12:fc888315e5fd 139 void executeSha256(MAX8614X &m, uint8_t *challenge, unsigned int challengeLen, bool romID)
phonemacro 7:5b7f7ec9efe0 140 {
phonemacro 10:0b940aff3bb8 141 int i, j, k;
phonemacro 7:5b7f7ec9efe0 142 uint8_t macData[256];
phonemacro 10:0b940aff3bb8 143 uint8_t inData[256];
phonemacro 7:5b7f7ec9efe0 144 uint8_t xData[256];
phonemacro 10:0b940aff3bb8 145 uint32_t x32Data[64];
phonemacro 7:5b7f7ec9efe0 146 uint32_t tmpData;
phonemacro 10:0b940aff3bb8 147 const unsigned int responseLen32 = 8;
phonemacro 7:5b7f7ec9efe0 148 uint8_t data[5];
phonemacro 11:ec7998257ec2 149
phonemacro 13:97854f761347 150 //- Enable SHA_DONE Interrupt
phonemacro 7:5b7f7ec9efe0 151 m.writeRegister(MAX8614X::MAX8614X_INT_ENABLE2_REG, MAX8614X::MAX8614X_IE_SHA_DONE_EN);
phonemacro 7:5b7f7ec9efe0 152
phonemacro 7:5b7f7ec9efe0 153 m.writeRegister(MAX8614X::MAX8614X_INT_ENABLE1_REG, 0); // Disable all other interrupts
phonemacro 7:5b7f7ec9efe0 154
phonemacro 13:97854f761347 155 //- Enable SHA_EN bit.
phonemacro 7:5b7f7ec9efe0 156 m.writeRegister(MAX8614X::MAX8614X_SHA_CFG_REG,MAX8614X::MAX8614X_SHACFG_SHA_EN);
phonemacro 7:5b7f7ec9efe0 157
phonemacro 13:97854f761347 158 //- Write 160-bit random challenge value to RAM using registers MEM_IDX and MEM_DATA.
phonemacro 7:5b7f7ec9efe0 159 // Enable Memory Write, Select Bank 0, address 0x00 to 0xFF
phonemacro 7:5b7f7ec9efe0 160 m.writeRegister(MAX8614X::MAX8614X_MEMORY_CONTROL_REG, MAX8614X::MAX8614X_MEMCNTRL_WR_EN_MASK | MAX8614X::MAX8614X_MEMCNTRL_BANK0_MASK);
phonemacro 7:5b7f7ec9efe0 161
phonemacro 7:5b7f7ec9efe0 162 printf("\r\n Raw Input Data\r\n\r\n");
phonemacro 7:5b7f7ec9efe0 163 for (i = 0; i < challengeLen; i++) {
phonemacro 10:0b940aff3bb8 164 if (!(i % 4))
phonemacro 10:0b940aff3bb8 165 printf("\r\n ");
phonemacro 10:0b940aff3bb8 166 printf("%02x", challenge[i]);
phonemacro 7:5b7f7ec9efe0 167 }
phonemacro 7:5b7f7ec9efe0 168 printf("\r\n");
phonemacro 10:0b940aff3bb8 169 #if 0
phonemacro 7:5b7f7ec9efe0 170 k = 0;
phonemacro 10:0b940aff3bb8 171 for (i = 0; i < (challengeLen/4); i++) {
phonemacro 10:0b940aff3bb8 172 for (j = 3; j >= 0; j--) {
phonemacro 10:0b940aff3bb8 173
phonemacro 10:0b940aff3bb8 174 inData[j+(i*4)] = challenge[k];
phonemacro 10:0b940aff3bb8 175 k++;
phonemacro 7:5b7f7ec9efe0 176 }
phonemacro 10:0b940aff3bb8 177 }
phonemacro 10:0b940aff3bb8 178 #endif
phonemacro 10:0b940aff3bb8 179
phonemacro 10:0b940aff3bb8 180 transformData(challenge, xData, challengeLen);
phonemacro 7:5b7f7ec9efe0 181
phonemacro 7:5b7f7ec9efe0 182 printf("\r\n Transformed Input Data\r\n\r\n");
phonemacro 10:0b940aff3bb8 183 for (i = 0; i < challengeLen; i++) {
phonemacro 7:5b7f7ec9efe0 184 if (!(i % 4))
phonemacro 7:5b7f7ec9efe0 185 printf("\r\n ");
phonemacro 7:5b7f7ec9efe0 186 printf("%02x", xData[i]);
phonemacro 7:5b7f7ec9efe0 187 }
phonemacro 7:5b7f7ec9efe0 188 printf("\r\n ");
phonemacro 7:5b7f7ec9efe0 189 printf("\r\n ");
phonemacro 7:5b7f7ec9efe0 190
phonemacro 10:0b940aff3bb8 191 for (i = 0; i < (challengeLen); i++) {
phonemacro 7:5b7f7ec9efe0 192 m.writeRegister(MAX8614X::MAX8614X_MEMORY_INDEX_REG, i);
phonemacro 7:5b7f7ec9efe0 193 m.writeRegister(MAX8614X::MAX8614X_MEMORY_DATA_REG, xData[i]);
phonemacro 10:0b940aff3bb8 194 //}
phonemacro 10:0b940aff3bb8 195 }
phonemacro 7:5b7f7ec9efe0 196 printf("%\r\n");
phonemacro 7:5b7f7ec9efe0 197 // The message block consists of a 160-bit secret, a 160-bit challenge and 192 bits of constant data. Optionally, the 64-bit
phonemacro 7:5b7f7ec9efe0 198 // ROM ID replaces 64 of the 192 bits of constant data used in the hash operation. 16 bits out of the 160-bit secret and 16
phonemacro 7:5b7f7ec9efe0 199 // bits of ROM ID are programmable–8 bits each in metal and 8 bits each in OTP bits
phonemacro 13:97854f761347 200 //- Write command, with ROM ID (0x35) or without ROM ID (0x36), to SHA_CMD register
phonemacro 12:fc888315e5fd 201 if (romID) {
phonemacro 12:fc888315e5fd 202 printf("ROMID \r\n");
phonemacro 13:97854f761347 203 // m.writeRegister(MAX8614X::MAX8614X_SHA_CMD_REG, MAX8614X::MAX8614X_SHACMD_MAC_ROM_ID);
phonemacro 12:fc888315e5fd 204 m.writeRegister(MAX8614X::MAX8614X_SHA_CMD_REG, MAX8614X::MAX8614X_SHACMD_MAC_ROM_ID);
phonemacro 12:fc888315e5fd 205 wait(1);
phonemacro 12:fc888315e5fd 206 }
phonemacro 12:fc888315e5fd 207 else
phonemacro 12:fc888315e5fd 208 {
phonemacro 12:fc888315e5fd 209 printf("no ROMID \r\n");
phonemacro 13:97854f761347 210 // m.writeRegister(MAX8614X::MAX8614X_SHA_CMD_REG,MAX8614X::MAX8614X_SHACMD_MAC_NO_ROM_ID);
phonemacro 12:fc888315e5fd 211 m.writeRegister(MAX8614X::MAX8614X_SHA_CMD_REG,MAX8614X::MAX8614X_SHACMD_MAC_NO_ROM_ID);
phonemacro 12:fc888315e5fd 212 wait(1);
phonemacro 12:fc888315e5fd 213 }
phonemacro 12:fc888315e5fd 214
phonemacro 12:fc888315e5fd 215
phonemacro 12:fc888315e5fd 216 // m.writeRegister(MAX8614X::MAX8614X_SHA_CMD_REG,MAX8614X::MAX8614X_SHACMD_MAC_ROM_ID);
phonemacro 7:5b7f7ec9efe0 217 // m.writeRegister(MAX8614X::MAX8614X_SHA_CMD_REG,MAX8614X::MAX8614X_SHACMD_MAC_NO_ROM_ID);
phonemacro 7:5b7f7ec9efe0 218
phonemacro 7:5b7f7ec9efe0 219
phonemacro 10:0b940aff3bb8 220 m.readRegister(MAX8614X::MAX8614X_SHA_CMD_REG, data, 1);
phonemacro 10:0b940aff3bb8 221 printf("sha cmd reg should be 0x35 mac rom id, reg %02X = %02X\r\n", MAX8614X::MAX8614X_SHA_CMD_REG, data[0]);
phonemacro 10:0b940aff3bb8 222 m.readRegister(MAX8614X::MAX8614X_INT_STATUS2_REG, data, 1);
phonemacro 10:0b940aff3bb8 223 printf("int status2, reg %02X = %X\r\n", MAX8614X::MAX8614X_INT_STATUS2_REG, data[0]);
phonemacro 7:5b7f7ec9efe0 224 //● Write 1 to SHA_START and 1 to SHA_EN bit.
phonemacro 7:5b7f7ec9efe0 225 m.writeRegister(MAX8614X::MAX8614X_SHA_CFG_REG,MAX8614X::MAX8614X_SHACFG_SHA_EN | MAX8614X::MAX8614X_SHACFG_SHA_START);
phonemacro 10:0b940aff3bb8 226 m.readRegister(MAX8614X::MAX8614X_SHA_CFG_REG, data, 1);
phonemacro 10:0b940aff3bb8 227 printf("sha CFG reg should be 0x3, reg %02X = %02X\r\n", MAX8614X::MAX8614X_SHA_CFG_REG, data[0]);
phonemacro 7:5b7f7ec9efe0 228
phonemacro 10:0b940aff3bb8 229 //● Wait for SHA_DONE interrupt.
phonemacro 10:0b940aff3bb8 230 m.clearShaComplete();
phonemacro 7:5b7f7ec9efe0 231 data[0] = 0;
phonemacro 10:0b940aff3bb8 232 // while(!m.isShaComplete()) {
phonemacro 10:0b940aff3bb8 233 while(!m.isShaComplete() && !data[0] ) {
phonemacro 7:5b7f7ec9efe0 234 m.readRegister(MAX8614X::MAX8614X_INT_STATUS2_REG, data, 1);
phonemacro 10:0b940aff3bb8 235 printf("int status2, reg %02X = %X\r\n", MAX8614X::MAX8614X_INT_STATUS2_REG, data[0]);
phonemacro 10:0b940aff3bb8 236
phonemacro 7:5b7f7ec9efe0 237 }
phonemacro 7:5b7f7ec9efe0 238 // ● Read 256 MAC value from RAM using registers MEM_IDX and MEM_DATA.
phonemacro 10:0b940aff3bb8 239 printf("\r\n Raw Output\r\n\r\n");
phonemacro 7:5b7f7ec9efe0 240 for (i = 64; i < 64+32; i++) {
phonemacro 7:5b7f7ec9efe0 241 if (!(i % 4))
phonemacro 7:5b7f7ec9efe0 242 printf("\r\n ");
phonemacro 7:5b7f7ec9efe0 243 m.writeRegister(MAX8614X::MAX8614X_MEMORY_INDEX_REG, i);
phonemacro 7:5b7f7ec9efe0 244 m.readRegister(MAX8614X::MAX8614X_MEMORY_DATA_REG, data, 1);
phonemacro 10:0b940aff3bb8 245 xData[i-64] = data[0];
phonemacro 7:5b7f7ec9efe0 246 printf("%02x", data[0]);
phonemacro 7:5b7f7ec9efe0 247 }
phonemacro 10:0b940aff3bb8 248 printf("%\r\n");
phonemacro 10:0b940aff3bb8 249
phonemacro 10:0b940aff3bb8 250 transformData(xData,macData, 32);
phonemacro 10:0b940aff3bb8 251 #if 0
phonemacro 10:0b940aff3bb8 252 printf("\r\n Formatted Response\r\n\r\n");
phonemacro 10:0b940aff3bb8 253 for (i = 0; i < 32; i++) {
phonemacro 10:0b940aff3bb8 254 if (!(i % 4))
phonemacro 10:0b940aff3bb8 255 printf("\r\n ");
phonemacro 10:0b940aff3bb8 256 printf("%02x", macData[i]);
phonemacro 10:0b940aff3bb8 257 }
phonemacro 10:0b940aff3bb8 258 printf("\r\n\r\n");
phonemacro 10:0b940aff3bb8 259
phonemacro 10:0b940aff3bb8 260 #endif
phonemacro 10:0b940aff3bb8 261 // transform data to Little-Endian
phonemacro 10:0b940aff3bb8 262 k = 0;
phonemacro 10:0b940aff3bb8 263 for (i = 0; i < (responseLen32); i++) {
phonemacro 10:0b940aff3bb8 264 tmpData = challenge[i];
phonemacro 10:0b940aff3bb8 265 x32Data[i] = 0;
phonemacro 10:0b940aff3bb8 266 for (j = 3; j >= 0; j--) {
phonemacro 10:0b940aff3bb8 267 x32Data[i] = x32Data[i] << 8;
phonemacro 10:0b940aff3bb8 268 x32Data[i] |= macData[k] & 0xFF;
phonemacro 10:0b940aff3bb8 269 k++;
phonemacro 10:0b940aff3bb8 270 }
phonemacro 10:0b940aff3bb8 271
phonemacro 10:0b940aff3bb8 272 }
phonemacro 10:0b940aff3bb8 273
phonemacro 10:0b940aff3bb8 274 printf("\r\n Formatted Response\r\n\r\n");
phonemacro 10:0b940aff3bb8 275 for (i = 0; i < responseLen32; i++) {
phonemacro 10:0b940aff3bb8 276 printf(" %08X \r\n",x32Data[i]);
phonemacro 10:0b940aff3bb8 277 }
phonemacro 10:0b940aff3bb8 278
phonemacro 10:0b940aff3bb8 279
phonemacro 7:5b7f7ec9efe0 280 }