void LockDevice (void) { // Disable volume access SetSdEncryptedCardEnableState (FALSE); SetSdEncryptedHiddenState (FALSE); AES_SetNewStorageKey ((u8 *) AES_DummyKey_au8); // Set dummy AES key HID_AdminPasswordEnabled_u32 = FALSE; HID_UserPasswordEnabled_u32 = FALSE; memset (HID_UserPassword_au8, 0, HID_PASSWORD_LEN); memset (HID_AdminPassword_au8, 0, HID_PASSWORD_LEN); // Disable password safe PWS_DisableKey (); // Powerdown smartcard ISO7816_SetLockCounter (0); CCID_SmartcardOff_u8 (); // or DFU_ResetCPU (); }
Bool scsi_decode_command (void) { Bool status = FALSE; if (TRUE == sd_mmc_mci_test_unit_only_local_access) { CI_StringOut ("SCSI: no external access\r\n"); sbc_lun_status_is_not_present (); return (TRUE); } // Log LUN activity if (2 > usb_LUN) { LastLunAccessInTick_u64[usb_LUN] = TIME_MEASURING_GetTime (); } DebugScsiCommand (g_scsi_command); switch (g_scsi_command[0]) // Check received command. { case SBC_CMD_TEST_UNIT_READY: // 0x00 - Mandatory. DelayMs (2); // To avoid USB host error status = sbc_test_unit_ready (); break; case SBC_CMD_REQUEST_SENSE: // 0x03 - Mandatory. status = sbc_request_sense (); break; case SBC_CMD_INQUIRY: // 0x12 - Mandatory. status = sbc_inquiry (); break; case SBC_CMD_MODE_SENSE_6: // 0x1A - Optional. status = sbc_mode_sense (FALSE); break; case SBC_CMD_PREVENT_ALLOW_MEDIUM_REMOVAL: // 0x1E - Optional. status = sbc_prevent_allow_medium_removal (); break; case SBC_CMD_READ_CAPACITY_10: // 0x25 - Mandatory. status = sbc_read_capacity (); break; case SBC_CMD_READ_10: // 0x28 - Mandatory. Scsi_start_read_action (); status = sbc_read_10 (); Scsi_stop_read_action (); break; case SBC_CMD_WRITE_10: // 0x2A - Optional. Scsi_start_write_action (); status = sbc_write_10 (); Scsi_stop_write_action (); break; case SBC_CMD_VERIFY_10: // 0x2F - Optional. status = TRUE; sbc_lun_status_is_good (); break; /* case SBC_CMD_MODE_SENSE_10: // 0x5A - Optional. status = sbc_mode_sense(TRUE); break; */ case SBC_CMD_START_STOP_UNIT: // 0x1B - Ignored. This command is used by the Linux 2.4 kernel, status = TRUE; sbc_lun_status_is_good (); { U8 Text[10]; CI_StringOut ("SCSI: START_STOP_UNIT - LUN "); Text[0] = usb_LUN + '0'; Text[1] = 0; CI_StringOut (Text); CI_StringOut (" - Start bit "); Text[0] = (g_scsi_command[4] & 0x01) + '0'; CI_StringOut (Text); CI_StringOut ("\r\n"); } if (0 == (g_scsi_command[4] & 0x01)) { SetSdUncryptedCardEnableState (FALSE); // Close all volumes SetSdEncryptedCardEnableState (FALSE); SetSdEncryptedHiddenState (FALSE); } else { SetSdUncryptedCardEnableState (TRUE); // Open only the unencrypted volume } break; // for which we can not reply INVALID COMMAND, otherwise the disk will not mount. case SBC_CMD_FORMAT_UNIT: // 0x04 - Mandatory. case SBC_CMD_REASSIGN_BLOCKS: // 0x07 - Optional. case SBC_CMD_READ_6: // 0x08 - Mandatory. case SBC_CMD_WRITE_6: // 0x0A - Optional. case SBC_CMD_MODE_SELECT_6: // 0x15 - Optional. case SBC_CMD_RECEIVE_DIAGNOSTIC_RESULTS: // 0x1C - Optional. case SBC_CMD_SEND_DIAGNOSTIC: // 0x1D - Mandatory. case SBC_CMD_WRITE_AND_VERIFY_10: // 0x2E - Optional. case SBC_CMD_PREFETCH_10: // 0x34 - Optional. case SBC_CMD_SYNCHRONIZE_CACHE_10: // 0x35 - Optional. case SBC_CMD_READ_DEFECT_DATA_10: // 0x37 - Optional. case SBC_CMD_WRITE_BUFFER: // 0x3B - Optional. case SBC_CMD_READ_BUFFER: // 0x3C - Optional. case SBC_CMD_READ_LONG_10: // 0x3E - Optional. case SBC_CMD_WRITE_LONG_10: // 0x3F - Optional. case SBC_CMD_WRITE_SAME_10: // 0x41 - Optional. case SBC_CMD_LOG_SELECT: // 0x4C - Optional. case SBC_CMD_LOG_SENSE: // 0x4D - Optional. case SBC_CMD_XDWRITE_10: // 0x50 - Optional. case SBC_CMD_XPWRITE_10: // 0x51 - Optional. case SBC_CMD_XDREAD_10: // 0x52 - Optional. case SBC_CMD_XDWRITEREAD_10: // 0x53 - Optional. case SBC_CMD_MODE_SELECT_10: // 0x55 - Optional. case SBC_CMD_PERSISTENT_RESERVE_IN: // 0x5E - Optional. case SBC_CMD_PERSISTENT_RESERVE_OUT: // 0x5F - Optional. case SBC_CMD_EXTENDED_COPY: // 0x83 - Optional. case SBC_CMD_RECEIVE_COPY_RESULTS: // 0x84 - Optional. case SBC_CMD_ACCESS_CONTROL_IN: // 0x86 - Optional. case SBC_CMD_ACCESS_CONTROL_OUT: // 0x87 - Optional. case SBC_CMD_READ_16: // 0x88 - Optional. case SBC_CMD_WRITE_16: // 0x8A - Optional. case SBC_CMD_READ_ATTRIBUTE: // 0x8C - Optional. case SBC_CMD_WRITE_ATTRIBUTE: // 0x8D - Optional. case SBC_CMD_WRITE_AND_VERIFY_16: // 0x8E - Optional. case SBC_CMD_VERIFY_16: // 0x8F - Optional. case SBC_CMD_PREFETCH_16: // 0x90 - Optional. case SBC_CMD_SYNCHRONIZE_CACHE_16: // 0x91 - Optional. case SBC_CMD_WRITE_SAME_16: // 0x93 - Optional. case SBC_CMD_REPORT_LUNS: // 0xA0 - Mandator. case SBC_CMD_READ_12: // 0xA8 - Optional. case SBC_CMD_WRITE_12: // 0xAA - Optional. case SBC_CMD_WRITE_AND_VERIFY_12: // 0xAE - Optional. case SBC_CMD_VERIFY_12: // 0xAF - Optional. case SBC_CMD_READ_DEFECT_DATA_12: // 0xB7 - Optional. default: // Command not supported. Sbc_send_failed (); Sbc_build_sense (usb_LUN, SBC_SENSE_KEY_ILLEGAL_REQUEST, SBC_ASC_INVALID_COMMAND_OPERATION_CODE, 0x00); break; } return status; }
void HID_ExcuteCmd (void) { u8 StorageKey_pu8[32]; u8 Cmd_u8; u8* PasswordMatrix_pu8; u8 ret_u8; u64 timestamp; u32 Len; Cmd_u8 = HID_CmdGet_u8; // Send a smart card status before the lock check if (HTML_CMD_CHECK_SMARTCARD_USAGE == Cmd_u8) { CI_TickLocalPrintf ("Check smartcard usage\r\n"); if (0 == USB_CCID_GetLockCounter ()) { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); CI_TickLocalPrintf ("smartcard not busy\r\n"); } else { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_SMARTCARD_ERROR, 0); CI_TickLocalPrintf ("smartcard busy\r\n"); } return; } // Check for active CCID command // If CCID command is active, wait with HID smart card access until CCID access has ended if (0 != USB_CCID_GetLockCounter ()) { // UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_BUSY, 0); // memset (HID_String_au8, 0, 50); // Clear input data, with possible sent passwords return; } // Check for matrix password > if yes convert the matrix to password switch (Cmd_u8) { case HTML_CMD_ENABLE_AES_LUN: case HTML_CMD_ENABLE_HIDDEN_AES_LUN: case HTML_CMD_DISABLE_HIDDEN_AES_LUN: case HTML_CMD_EXPORT_BINARY: case HTML_CMD_GENERATE_NEW_KEYS: case HTML_CMD_ENABLE_READWRITE_UNCRYPTED_LUN: case HTML_CMD_CLEAR_NEW_SD_CARD_FOUND: switch (HID_String_au8[0]) { case 'P': // normal password // Do nothing break; case 'M': // matrix password // Convert matrix input to password if (FALSE == ConvertMatrixDataToPassword (&HID_String_au8[1])) { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); return; } break; } break; case HTML_CMD_FILL_SD_WITH_RANDOM_CHARS: switch (HID_String_au8[1]) { case 'P': // normal password // Do nothing break; case 'M': // matrix password // Convert matrix input to password if (FALSE == ConvertMatrixDataToPassword (&HID_String_au8[2])) { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); return; } break; } break; } // Check for hidden password if (TRUE == HID_NextPasswordIsHiddenPassword_u32) { switch (Cmd_u8) { case HTML_CMD_ENABLE_AES_LUN: Cmd_u8 = HTML_CMD_ENABLE_HIDDEN_AES_LUN; CI_TickLocalPrintf ("Redirect password -%s- to hidden volume\r\n", &HID_String_au8[1]); SetSdEncryptedCardEnableState (FALSE); SetSdEncryptedHiddenState (FALSE); CI_TickLocalPrintf ("Unmount crypted volume\r\n"); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_BUSY_PROGRESSBAR, 50); vTaskDelay (1000); // Wait that pc unmount old volume break; } } // switch (Cmd_u8) { case HTML_CMD_NOTHING: break; case HTML_CMD_ENABLE_AES_LUN: if (TRUE == IW_SendToSC_PW1 (&HID_String_au8[1])) { SetSdEncryptedHiddenState (FALSE); SetSdEncryptedCardEnableState (FALSE); // Disable crypted or hidden volume vTaskDelay (3000); CI_TickLocalPrintf ("Get key for crypted volume\r\n"); u8 isKeyZero = TRUE; u8 isKeyValid = GetStorageKey_u32 (&HID_String_au8[1], StorageKey_pu8); // check if retrieved key is all-zeroes if (TRUE == isKeyValid) { u8 keyByte; for (keyByte = 0; keyByte < sizeof(StorageKey_pu8); keyByte++) { if (StorageKey_pu8[keyByte] != 0) { isKeyZero = FALSE; break; } } } // Terminate mounting procedure if key could not be retrieved or is all-zero if (FALSE == isKeyValid || TRUE == isKeyZero) { UpdateStick20Command (CMD_STATUS_AES_DEC_FAILED, 0); HID_NextPasswordIsHiddenPassword_u32 = FALSE; break; } AES_SetNewStorageKey (StorageKey_pu8); SetSdEncryptedCardEnableState (TRUE); DecryptedHiddenVolumeSlotsData (); PWS_DecryptedPasswordSafeKey (); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); /* HID_NextPasswordIsHiddenPassword_u32 = TRUE; // switch on redirection of aes volume password CI_TickLocalPrintf ("Next AES volume password is used for hidden volume\r\n"); */ CI_TickLocalPrintf ("SD card AES LUN enabled\r\n"); } else { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); HID_NextPasswordIsHiddenPassword_u32 = FALSE; CI_TickLocalPrintf ("*** wrong password ***\r\n"); } break; case HTML_CMD_DISABLE_AES_LUN: SetSdEncryptedCardEnableState (FALSE); SetSdEncryptedHiddenState (FALSE); AES_SetNewStorageKey ((u8 *) AES_DummyKey_au8); // Set dummy key HID_NextPasswordIsHiddenPassword_u32 = FALSE; UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); CI_TickLocalPrintf ("SD card AES LUN disabled\r\n"); break; case HTML_CMD_ENABLE_FIRMWARE_UPDATE: CI_TickLocalPrintf ("Firmware update - "); /* if (TRUE == flashc_is_security_bit_active ()) { CI_TickLocalPrintf ("Security bit is active. No Update\r\n"); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_SECURITY_BIT_ACTIVE, 0); break; } */ if (TRUE == CheckUpdatePin (&HID_String_au8[1], strlen ((char*)&HID_String_au8[1]))) { CI_TickLocalPrintf ("good bye\r\n"); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); DelayMs (500); // Wait to send answer to host DFU_EnableFirmwareUpdate (); DFU_ResetCPU (); } else { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); CI_TickLocalPrintf ("wrong password\r\n"); } break; case HTML_CMD_FILL_SD_WITH_RANDOM_CHARS: if (TRUE == IW_SendToSC_PW3 (&HID_String_au8[2])) { CI_TickLocalPrintf ("Fill SD card with random numbers - it runs very long, 1 GB ca. 4 minutes\r\n"); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_BUSY_PROGRESSBAR, 0); // Disable all SD card access via USB // SetSdUncryptedCardEnableState (FALSE); // look for >> sd_mmc_mci_test_unit_only_local_access = hard disabel // SetSdEncryptedCardEnableState (FALSE); // SetSdEncryptedHiddenState (FALSE); // vTaskDelay (3000); AES_SetNewStorageKey ((u8 *) AES_DummyKey_au8); // Set dummy key // if (STICK20_FILL_SD_CARD_WITH_RANDOM_CHARS_ALL_VOL == HID_String_au8[0]) { SD_SecureEraseHoleCard (); } else { // SD_SecureEraseCryptedVolume (); } SD_SecureEraseCryptedVolume (); SetSdCardFilledWithRandomsToFlash (); // Enable uncrypted SD card access via USB // SetSdUncryptedCardEnableState (TRUE); // SetSdUncryptedCardReadWriteEnableState (READ_WRITE_ACTIVE); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_BUSY_PROGRESSBAR, 100); vTaskDelay (500); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); vTaskDelay (500); // usb_restart (); // Restart USB // DFU_ResetCPU (); // Reboot to get correct volume data } else { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); CI_TickLocalPrintf ("wrong password\r\n"); } break; case HTML_CMD_ENABLE_HIDDEN_AES_LUN: // SetSdUncryptedCardEnableState (FALSE); // look for >> sd_mmc_mci_test_unit_only_local_access = hard disabel // Get w AES key for hidden volume - we use always the password that was send memset (StorageKey_pu8, 0, 32); ret_u8 = GetHiddenVolumeKeyFromUserpassword ((u8 *) & HID_String_au8[1], StorageKey_pu8); switch (ret_u8) { case HIDDEN_VOLUME_OUTPUT_STATUS_OK: SetSdEncryptedCardEnableState (FALSE); SetSdEncryptedHiddenState (FALSE); AES_SetNewStorageKey ((u8 *) AES_DummyKey_au8); // Set dummy key vTaskDelay (3000); // Wait 3 sec to send LUN not active AES_SetNewStorageKey (StorageKey_pu8); SetSdEncryptedHiddenState (TRUE); SetSdEncryptedCardEnableState (TRUE); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); CI_TickLocalPrintf ("Hidden volume - SD card hidden AES LUN enabled\r\n"); break; case HIDDEN_VOLUME_OUTPUT_STATUS_WRONG_PASSWORD: CI_TickLocalPrintf ("Hidden volume - wrong password\r\n"); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); break; case HIDDEN_VOLUME_OUTPUT_STATUS_NO_USER_PASSWORD_UNLOCK: CI_TickLocalPrintf ("Hidden volume - no user password\r\n"); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_NO_USER_PASSWORD_UNLOCK, 0); break; case HIDDEN_VOLUME_OUTPUT_STATUS_SMARTCARD_ERROR: CI_TickLocalPrintf ("Hidden volume - smartcard error\r\n"); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_SMARTCARD_ERROR, 0); break; default: break; } HID_NextPasswordIsHiddenPassword_u32 = FALSE; // switch off redirection of aes volume password break; case HTML_CMD_DISABLE_HIDDEN_AES_LUN: SetSdEncryptedCardEnableState (FALSE); SetSdEncryptedHiddenState (FALSE); memset (StorageKey_pu8, 0, 32); // Set dummy key AES_SetNewStorageKey ((u8 *) AES_DummyKey_au8); // Set dummy key HID_NextPasswordIsHiddenPassword_u32 = FALSE; vTaskDelay (3000); // Wait 3 sec to send LUN not active CI_TickLocalPrintf ("SD card hidden AES LUN disabled\r\n"); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); break; case HTML_CMD_EXPORT_BINARY: if (TRUE == IW_SendToSC_PW3 (&HID_String_au8[1])) { CI_TickLocalPrintf ("Export binary\r\n"); // SetSdUncryptedCardEnableState (FALSE); // todo: Check disable access, don't work here FileIO_SaveAppImage_u8 (); SetSdUncryptedCardEnableState (FALSE); // Disable access vTaskDelay (3000); SetSdUncryptedCardEnableState (TRUE); // Enable access UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); } else { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); CI_TickLocalPrintf ("*** wrong password ***\r\n"); } break; case HTML_CMD_GENERATE_NEW_KEYS: { u8 CmdOk_u8 = TRUE; u8 SdCardFilledWithRandoms_u8; u8 StickKeysNotInitiated_u8; // Save old state SdCardFilledWithRandoms_u8 = StickConfiguration_st.SDFillWithRandomChars_u8; StickKeysNotInitiated_u8 = StickConfiguration_st.StickKeysNotInitiated_u8; CI_TickLocalPrintf ("Generate new keys Old State KNI %d, SDF %d\r\n",StickKeysNotInitiated_u8,SdCardFilledWithRandoms_u8); if (TRUE == BuildStorageKeys_u32 ((u8 *) & HID_String_au8[1])) { SetSdEncryptedCardEnableState (FALSE); SetSdEncryptedHiddenState (FALSE); memset (StorageKey_pu8, 0, 32); AES_SetNewStorageKey ((u8 *) AES_DummyKey_au8); // Set dummy key } else { CmdOk_u8 = FALSE; } if (TRUE == SdCardFilledWithRandoms_u8) // Restore old state { SetSdCardFilledWithRandomsToFlash (); } if (FALSE == StickKeysNotInitiated_u8) // Restore old state { ClearStickKeysNotInitatedToFlash (); } if (TRUE == CmdOk_u8) { CI_TickLocalPrintf ("Generate new keys for hidden volume slots\r\n"); if (FALSE == InitHiddenSlots ()) { CmdOk_u8 = FALSE; } } if (TRUE == CmdOk_u8) { CI_TickLocalPrintf ("Generate new keys for password safe store\r\n"); if (FALSE == BuildPasswordSafeKey_u32 ()) { CmdOk_u8 = FALSE; } } if (TRUE == CmdOk_u8) { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); } else { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); } } break; case HTML_CMD_ENABLE_READONLY_UNCRYPTED_LUN: CI_TickLocalPrintf ("Set readonly to unencrypted volume\r\n"); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); CI_TickLocalPrintf ("*** wrong password - NOT USED ***\r\n"); break; case HTML_CMD_ENABLE_READWRITE_UNCRYPTED_LUN: CI_TickLocalPrintf ("Set readwrite to unencrypted volume\r\n"); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); CI_TickLocalPrintf ("*** wrong password - NOT USED ***\r\n"); break; case HTML_CMD_SEND_PASSWORD_MATRIX: CI_TickLocalPrintf ("Get SEND_PASSWORD_MATRIX\r\n"); PasswordMatrix_pu8 = GetCorrectMatrix (); Stick20HIDInitSendMatrixData (PasswordMatrix_pu8); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_PASSWORD_MATRIX_READY, 0); break; case HTML_CMD_SEND_PASSWORD_MATRIX_PINDATA: CI_TickLocalPrintf ("Get SEND_PASSWORD_MATRIX_PINDATA\r\n"); CI_TickLocalPrintf ("Data 1 : %s\r\n", HID_String_au8); // PasswordMatrix_pu8 = GetCorrectMatrix (); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); break; case HTML_CMD_SEND_PASSWORD_MATRIX_SETUP: CI_TickLocalPrintf ("Get SEND_PASSWORD_MATRIX_SETUP\r\n"); CI_TickLocalPrintf ("Data : %s\r\n", HID_String_au8); WriteMatrixColumsUserPWToUserPage (&HID_String_au8[1]); // Data is in ASCII UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); break; case HTML_CMD_GET_DEVICE_STATUS: CI_TickLocalPrintf ("Get HTML_CMD_GET_DEVICE_STATUS\r\n"); StickConfiguration_st.FirmwareLocked_u8 = FALSE; if (TRUE == flashc_is_security_bit_active ()) { StickConfiguration_st.FirmwareLocked_u8 = TRUE; } GetSmartCardStatus (&StickConfiguration_st); Stick20HIDInitSendConfiguration (STICK20_SEND_STATUS_PIN); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); break; case HTML_CMD_WRITE_STATUS_DATA: CI_TickLocalPrintf ("Get HTML_CMD_WRITE_STATUS_DATA\r\n"); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); break; case HTML_SEND_HIDDEN_VOLUME_SETUP: CI_TickLocalPrintf ("Get HTML_SEND_HIDDEN_VOLUME_SETUP\r\n"); InitRamdomBaseForHiddenKey (); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); break; case HTML_CMD_SEND_PASSWORD: CI_TickLocalPrintf ("Get HTML_CMD_SEND_PASSWORD\r\n"); HID_AdminPasswordEnabled_u32 = FALSE; HID_UserPasswordEnabled_u32 = FALSE; switch (HID_String_au8[0]) { case 'P': ret_u8 = IW_SendToSC_PW1 (&HID_String_au8[1]); HID_UserPasswordEnabled_u32 = ret_u8; strncpy ((char *) HID_UserPassword_au8, (char *) &HID_String_au8[1], HID_PASSWORD_LEN); break; case 'A': ret_u8 = IW_SendToSC_PW3 (&HID_String_au8[1]); HID_AdminPasswordEnabled_u32 = ret_u8; strncpy ((char *) HID_AdminPassword_au8, (char *) &HID_String_au8[1], HID_PASSWORD_LEN); break; } if (TRUE == ret_u8) { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); CI_TickLocalPrintf ("password ok\r\n"); } else { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); CI_TickLocalPrintf ("*** wrong password ***\r\n"); } break; case HTML_CMD_SEND_NEW_PASSWORD: CI_TickLocalPrintf ("Get HTML_CMD_SEND_NEW_PASSWORD\r\n"); ret_u8 = FALSE; switch (HID_String_au8[0]) { case 'P': if (TRUE == HID_UserPasswordEnabled_u32) { ret_u8 = LA_OpenPGP_V20_Test_ChangeUserPin (HID_UserPassword_au8, &HID_String_au8[1]); } else { CI_TickLocalPrintf ("** User password not present ***\r\n"); } break; case 'A': if (TRUE == HID_AdminPasswordEnabled_u32) { ret_u8 = LA_OpenPGP_V20_Test_ChangeAdminPin (HID_AdminPassword_au8, &HID_String_au8[1]); } else { CI_TickLocalPrintf ("** Admin password not present ***\r\n"); } break; } if (TRUE == ret_u8) { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); CI_TickLocalPrintf ("password change ok\r\n"); } else { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); CI_TickLocalPrintf ("*** password NOT changed ***\r\n"); } // Clear password HID_AdminPasswordEnabled_u32 = FALSE; HID_UserPasswordEnabled_u32 = FALSE; memset (HID_UserPassword_au8, 0, HID_PASSWORD_LEN); memset (HID_AdminPassword_au8, 0, HID_PASSWORD_LEN); break; case HTML_CMD_CLEAR_NEW_SD_CARD_FOUND: CI_TickLocalPrintf ("Get HTML_CMD_CLEAR_NEW_SD_CARD_FOUND\r\n"); if (TRUE == IW_SendToSC_PW3 (&HID_String_au8[1])) { ClearNewSdCardFoundToFlash (); SetSdCardFilledWithRandomCharsToFlash (); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); CI_TickLocalPrintf ("password ok\r\n"); } else { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); CI_TickLocalPrintf ("*** wrong password ***\r\n"); } break; case HTML_CMD_SEND_STARTUP: CI_TickLocalPrintf ("Get HTML_CMD_SEND_STARTUP\r\n"); timestamp = getu64 (&HID_String_au8[0]); if (FALSE == CheckSystemtime ((u32) timestamp)) { // todo } GetSmartCardStatus (&StickConfiguration_st); Stick20HIDInitSendConfiguration (STICK20_SEND_STARTUP); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); break; /* case STICK20_CMD_SEND_PASSWORD_RETRY_COUNT : CI_TickLocalPrintf ("Get STICK20_CMD_SEND_PASSWORD_RETRY_COUNT\r\n"); // Stick20HIDInitSendConfiguration (STICK20_SEND_STARTUP); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK,0); break; */ case HTML_CMD_HIDDEN_VOLUME_SETUP: CI_TickLocalPrintf ("Get HTML_CMD_HIDDEN_VOLUME_SETUP\r\n"); ret_u8 = SetupUpHiddenVolumeSlot ((HiddenVolumeSetup_tst *) & HID_String_au8[0]); switch (ret_u8) { case HIDDEN_VOLUME_OUTPUT_STATUS_OK: UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); break; case HIDDEN_VOLUME_OUTPUT_STATUS_WRONG_PASSWORD: UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); break; case HIDDEN_VOLUME_OUTPUT_STATUS_NO_USER_PASSWORD_UNLOCK: UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_NO_USER_PASSWORD_UNLOCK, 0); break; case HIDDEN_VOLUME_OUTPUT_STATUS_SMARTCARD_ERROR: UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_SMARTCARD_ERROR, 0); break; default: break; } break; case HTML_CMD_CLEAR_STICK_KEYS_NOT_INITIATED: CI_TickLocalPrintf ("Get HTML_CMD_CLEAR_STICK_KEYS_NOT_INITIATED\r\n"); ClearStickKeysNotInitatedToFlash (); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); break; case HTML_CMD_CLEAR_LOCK_STICK_HARDWARE: CI_TickLocalPrintf ("Get HTML_CMD_CLEAR_LOCK_STICK_HARDWARE\r\n"); if (TRUE == IW_SendToSC_PW3 (&HID_String_au8[1])) { CI_TickLocalPrintf ("Lock firmware\r\n"); // flashc_set_bootloader_protected_size (0x10000); // Set bootloader protection to the max protection value, to lock the first 56k of the application flashc_activate_security_bit (); // Debugging disabled, only chip erase works (bootloader is save) , AES storage keys and setup // are erased UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); } else { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); CI_TickLocalPrintf ("*** worng password ***\r\n"); } break; case HTML_CMD_PRODUCTION_TEST: CI_TickLocalPrintf ("Get HTML_CMD_PRODUCTION_TEST\r\n"); GetProductionInfos (&Stick20ProductionInfos_st,FALSE); Stick20HIDInitSendConfiguration (STICK20_SEND_PRODUCTION_TEST); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); break; case HTML_CMD_PRODUCTION_TEST_WITH_WRITE_TEST: CI_TickLocalPrintf ("Get HTML_CMD_PRODUCTION_TEST_WITH_WRITE_TEST\r\n"); GetProductionInfos (&Stick20ProductionInfos_st,TRUE); Stick20HIDInitSendConfiguration (STICK20_SEND_PRODUCTION_TEST); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); break; case HTML_CMD_CHANGE_UPDATE_PIN: CI_TickLocalPrintf ("Get HTML_CMD_CHANGE_UPDATE_PIN\r\n"); Len = strlen ((char*)&HID_String_au8[1]); if (TRUE == CheckUpdatePin (&HID_String_au8[1], Len)) { Len = strlen ((char*)&HID_String_au8[22]); if (TRUE == StoreNewUpdatePinHashInFlash (&HID_String_au8[22], Len)) // Start of new PW { CI_TickLocalPrintf ("Update PIN changed\r\n"); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); } else { CI_TickLocalPrintf ("*** worng password len ***\r\n"); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); } } else { CI_TickLocalPrintf ("*** worng password ***\r\n"); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); } break; case HTML_CMD_ENABLE_ADMIN_READONLY_UNCRYPTED_LUN: CI_TickLocalPrintf ("Set readonly to unencrypted volume ADMIN\r\n"); if (TRUE == IW_SendToSC_PW3 (&HID_String_au8[1])) { SetSdUncryptedCardEnableState (FALSE); // Disable access SetSdEncryptedCardEnableState (FALSE); SetSdUncryptedCardReadWriteEnableState (READ_ONLY_ACTIVE); vTaskDelay (6000); SetSdUncryptedCardEnableState (TRUE); // Enable access UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); CI_TickLocalPrintf ("ok\r\n"); } else { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); CI_TickLocalPrintf ("*** wrong password ***\r\n"); } break; case HTML_CMD_ENABLE_ADMIN_READWRITE_UNCRYPTED_LUN: CI_TickLocalPrintf ("Set readwrite to unencrypted volume ADMIN\r\n"); if (TRUE == IW_SendToSC_PW3 (&HID_String_au8[1])) { SetSdUncryptedCardEnableState (FALSE); // Disable access SetSdEncryptedCardEnableState (FALSE); SetSdUncryptedCardReadWriteEnableState (READ_WRITE_ACTIVE); vTaskDelay (6000); SetSdUncryptedCardEnableState (TRUE); // Enable access UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); CI_TickLocalPrintf ("ok\r\n"); } else { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); CI_TickLocalPrintf ("*** wrong password ***\r\n"); } break; case HTML_CMD_ENABLE_ADMIN_READONLY_ENCRYPTED_LUN: CI_TickLocalPrintf ("Set readonly to encrypted volume\r\n"); if (TRUE == IW_SendToSC_PW3 (&HID_String_au8[1])) { SetSdUncryptedCardEnableState (FALSE); // Disable access SetSdEncryptedCardEnableState (FALSE); SetSdEncryptedCardReadWriteEnableState (READ_ONLY_ACTIVE); vTaskDelay (6000); // SetSdEncryptedCardEnableState (TRUE); // Enable access UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); CI_TickLocalPrintf ("ok\r\n"); } else { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); CI_TickLocalPrintf ("*** wrong password ***\r\n"); } break; case HTML_CMD_ENABLE_ADMIN_READWRITE_ENCRYPTED_LUN: CI_TickLocalPrintf ("Set readwrite to encrypted volume ADMIN\r\n"); if (TRUE == IW_SendToSC_PW3 (&HID_String_au8[1])) { SetSdUncryptedCardEnableState (FALSE); // Disable access SetSdEncryptedCardEnableState (FALSE); SetSdEncryptedCardReadWriteEnableState (READ_WRITE_ACTIVE); vTaskDelay (6000); // SetSdEncryptedCardEnableState (TRUE); // Enable access UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); CI_TickLocalPrintf ("ok\r\n"); } else { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_WRONG_PASSWORD, 0); CI_TickLocalPrintf ("*** wrong password ***\r\n"); } break; case HTML_CMD_CHECK_SMARTCARD_USAGE: CI_TickLocalPrintf ("Check smartcard usage\r\n"); if (0 == USB_CCID_GetLockCounter ()) { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); CI_TickLocalPrintf ("smartcard not busy\r\n"); } else { UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_SMARTCARD_ERROR, 0); CI_TickLocalPrintf ("smartcard busy\r\n"); } break; case HTML_CMD_WINK: CI_TickLocalPrintf ("Get HTML_CMD_WINK\r\n"); LED_WinkOn (); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_OK, 0); break; default: CI_TickLocalPrintf ("HID_ExcuteCmd: Get unknown command: %d \r\n", Cmd_u8); UpdateStick20Command (OUTPUT_CMD_STICK20_STATUS_IDLE, 0); break; } HID_CmdGet_u8 = HTML_CMD_NOTHING; memset (HID_String_au8, 0, 50); // Clear input data, with possible sent passwords /* HID_SmartcardAccess_u8 = FALSE; */ }