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; */
}
