Ejemplo n.º 1
0
u32 BuildPasswordSafeKey_u32 (void)
{
u8 Key_au8[AES_KEYSIZE_256_BIT];

    CI_TickLocalPrintf ("BuildPasswordSafeKey_u32\r\n");
    RestartSmartcard ();
    // LA_RestartSmartcard_u8 ();

    // Get a random number for the master key
    if (FALSE == getRandomNumber (AES_KEYSIZE_256_BIT / 2, Key_au8))
    {
        CI_LocalPrintf ("GetRandomNumber fails 1\n\r");
        return (FALSE);
    }

    // Get a random number for the master key
    if (FALSE == getRandomNumber (AES_KEYSIZE_256_BIT / 2, &Key_au8[AES_KEYSIZE_256_BIT / 2]))
    {
        CI_LocalPrintf ("GetRandomNumber fails 2\n\r");
        return (FALSE);
    }

    WritePasswordSafeKey (Key_au8);

    // Old Key is invalid
    DecryptedPasswordSafeKey_u8 = FALSE;

    return (TRUE);
}
u8 InitRamdomBaseForHiddenKey (void)
{
u8 BaseKey_au8[AES_KEYSIZE_256_BIT];

    LA_SC_StartSmartcard ();

    CI_TickLocalPrintf ("InitRamdomBaseForHiddenKey\r\n");

    // Get a random number for the base key
    if (FALSE == GetRandomNumber_u32 (AES_KEYSIZE_256_BIT / 2, BaseKey_au8))
    {
        CI_LocalPrintf ("GetRandomNumber fails\n\r");
        return (FALSE);
    }

    // Get a random number for the storage key
    if (FALSE == GetRandomNumber_u32 (AES_KEYSIZE_256_BIT / 2, &BaseKey_au8[AES_KEYSIZE_256_BIT / 2]))
    {
        CI_LocalPrintf ("GetRandomNumber fails\n\r");
        return (FALSE);
    }

    CI_LocalPrintf ("Base key       : ");
    HexPrint (AES_KEYSIZE_256_BIT, BaseKey_au8);
    CI_LocalPrintf ("\r\n");

    // Save base key
    WriteHiddenVolumeSlotKey (BaseKey_au8);

    // Invalidate hidden volume data
    DecryptedHiddenVolumeSlotsActive_u8 = FALSE;

    return (TRUE);
}
Ejemplo n.º 3
0
void GetProductionInfos (typeStick20ProductionInfos_st * Infos_st,u8 WriteTestEnabled)
{
typeStick20Configuration_st SC_Status_st;
volatile u32* id_data = (u32 *) 0x80800204; // Place of 120 bit CPU ID
u32 i;
u32 CPU_ID_u32;
cid_t* cid;
u32 Blockcount_u32;

    // Clear data field
    memset ((void *) Infos_st, 0, sizeof (Infos_st));

    Infos_st->FirmwareVersion_au8[0]     = VERSION_MAJOR;
    Infos_st->FirmwareVersion_au8[1]     = VERSION_MINOR;
    Infos_st->FirmwareVersionInternal_u8 = INTERNAL_VERSION_NR;

    if (TRUE == WriteTestEnabled)
    {
      // Get smartcard infos
      GetSmartCardStatus (&SC_Status_st);

      // Run the check only if the initial pw is aktive
      if (3 == SC_Status_st.UserPwRetryCount)
      {
          if (FALSE == LA_OpenPGP_V20_Test_SendUserPW2 ((unsigned char *) "123456"))
          {
              CI_TickLocalPrintf ("GetProductionInfos: Intial password is not activ\r\n");
              Infos_st->SC_AdminPwRetryCount = 99;    // Marker for wrong pw
              return;
          }
      }
      else
      {
          CI_TickLocalPrintf ("GetProductionInfos: Password retry count is not 3 : %d\r\n", SC_Status_st.UserPwRetryCount);
          Infos_st->SC_AdminPwRetryCount = 88;    // Marker for wrong pw retry count
          return;
      }
    }

    // Get XORed CPU ID
    CPU_ID_u32 = 0;
    for (i = 0; i < 4; i++)
    {
          CPU_ID_u32 ^= id_data[i];
    }
    Infos_st->CPU_CardID_u32 = CPU_ID_u32;

    // Init SD - read capacity
    sd_mmc_mci_read_capacity (SD_SLOT, (unsigned long int *) &Blockcount_u32);

    Infos_st->SD_Card_Size_u8 = Blockcount_u32 / 2 / 1024 / 1024 + 1;   // in GB

    // Save smartcard infos
    if (TRUE == WriteTestEnabled)
    {
      Infos_st->SC_UserPwRetryCount = SC_Status_st.UserPwRetryCount;
      Infos_st->SC_AdminPwRetryCount = SC_Status_st.AdminPwRetryCount;
      Infos_st->SmartCardID_u32 = SC_Status_st.ActiveSmartCardID_u32;
    }
    else
    {
      Infos_st->SC_UserPwRetryCount  = 0;
      Infos_st->SC_AdminPwRetryCount = 0;
      Infos_st->SmartCardID_u32      = 0;
    }

    // Get SD card infos
    cid = (cid_t *) GetSdCidInfo ();

    Infos_st->SD_CardID_u32 = (cid->psnh << 8) + cid->psnl;
    Infos_st->SD_Card_ManufacturingYear_u8 = cid->mdt / 16;
    Infos_st->SD_Card_ManufacturingMonth_u8 = cid->mdt % 0x0f;
    Infos_st->SD_Card_OEM_u16 = cid->oid;
    Infos_st->SD_Card_Manufacturer_u8 = cid->mid;

    // Get SD card speed
    if (TRUE == WriteTestEnabled)
    {
      Infos_st->SD_WriteSpeed_u16 = SD_SpeedTest ();
    }
    else
    {
      Infos_st->SD_WriteSpeed_u16 = 0;
    }

}
Ejemplo n.º 4
0
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; */


}