139 lines
3.8 KiB
C
139 lines
3.8 KiB
C
// Author: redlineo, romanov.pd@gmail.com
|
|
|
|
#include "red_crypto.h"
|
|
|
|
uint8_t dec_pass[2][16] = {{0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}, {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}};
|
|
|
|
uint8_t readed_key[32] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
|
|
|
|
uint8_t count_char_key = 0;
|
|
|
|
uint8_t crypto_mode = 0;
|
|
|
|
void print_chars_w128(w128_t *x) {
|
|
for (uint8_t i = 0; i < 16; i++) {
|
|
if (x->b[i] == 0x00) break;
|
|
printf("%c", x->b[i]);
|
|
}
|
|
dprintf("\n");
|
|
};
|
|
|
|
void print_chars(uint8_t *c) {
|
|
for (uint8_t i = 0; i < 32; i++) {
|
|
if (c[i] == 0x00) break;
|
|
printf("%c", c[i]);
|
|
}
|
|
dprintf("\n");
|
|
};
|
|
|
|
void print_int(uint8_t *c) {
|
|
for (uint8_t i = 0; i < 32; i++) {
|
|
printf("%d", c[i]);
|
|
}
|
|
dprintf("\n");
|
|
};
|
|
|
|
void decrypt_pass_kuzn(const uint8_t encrypted_passwords[2][16]) {
|
|
kuz_key_t key;
|
|
w128_t x;
|
|
|
|
kuz_set_decrypt_key(&key, readed_key);
|
|
for (uint8_t j = 0; j < 2; j++) {
|
|
for (uint8_t i = 0; i < 16; i++) {
|
|
x.b[i] = encrypted_passwords[j][i];
|
|
}
|
|
kuz_decrypt_block(&key, &x);
|
|
|
|
dprintf("decrypted\t=");
|
|
print_w128(&x);
|
|
print_chars_w128(&x);
|
|
|
|
for (uint8_t i = 0; i < 16; i++) {
|
|
dec_pass[j][i] = x.b[i];
|
|
}
|
|
}
|
|
|
|
};
|
|
|
|
// TODO: add encrypt new passwords with binding on new keys
|
|
// and storing all these to EEPROM
|
|
// void encrypt_pass_kuzn(){
|
|
// kuz_set_encrypt_key(&key,readed_key);
|
|
// for (uint8_t i=0; i<16; i++) {
|
|
// x.b[i] = pass[i];
|
|
// }
|
|
// kuz_encrypt_block(&key,&x);
|
|
// printf("encrypted\t="); print_w128(&x);
|
|
// print_chars_w128(&x);
|
|
// }
|
|
|
|
void send_chars_pass(uint8_t *out) {
|
|
for (uint8_t i = 0; i < 16 && out[i] != 0; i++) {
|
|
send_char((char)out[i]);
|
|
}
|
|
};
|
|
|
|
uint8_t crypto_process_record_user(uint16_t keycode, keyrecord_t *record, const uint8_t encrypted_passwords[2][16]) {
|
|
if (crypto_mode) {
|
|
switch (keycode) {
|
|
// case KC_1:
|
|
// if (record->event.pressed) {
|
|
// readed_key[count_char_key] = ASCII_LOW_1;
|
|
// count_char_key++;
|
|
// }
|
|
// return 1;
|
|
// break;
|
|
case RED_CRY_M:
|
|
if (record->event.pressed) {
|
|
print_int(readed_key);
|
|
crypto_mode = 0;
|
|
count_char_key = 0;
|
|
decrypt_pass_kuzn(encrypted_passwords);
|
|
}
|
|
default:
|
|
return kc_to_ascii(keycode, record, readed_key, &count_char_key);
|
|
break;
|
|
}
|
|
} else {
|
|
switch (keycode) {
|
|
case RED_PASS1:
|
|
if (record->event.pressed) {
|
|
send_chars_pass(dec_pass[0]);
|
|
}
|
|
break;
|
|
case RED_PASS2:
|
|
if (record->event.pressed) {
|
|
send_chars_pass(dec_pass[1]);
|
|
}
|
|
break;
|
|
case RED_RNG:
|
|
if (record->event.pressed) {
|
|
// TODO: change seed
|
|
for (uint8_t i = 0; i < 32; i++) {
|
|
tap_random_base64();
|
|
}
|
|
}
|
|
break;
|
|
case RED_TEST:
|
|
#ifdef TEST_FUNCTIONS_ENABLED
|
|
if (record->event.pressed) {
|
|
exec_sha256_test();
|
|
exec_kuznechik_test();
|
|
exec_aes_test();
|
|
}
|
|
#endif
|
|
break;
|
|
case RED_CRY_M:
|
|
if (record->event.pressed) {
|
|
crypto_mode = 1;
|
|
for (uint8_t i = 0; i < 32; i++) {
|
|
readed_key[i] = 0;
|
|
}
|
|
// dprintf("%d", keycode);
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|