encrypt.c 920 B

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152
  1. #include <stdint.h>
  2. #include <stdlib.h>
  3. #include <unistd.h>
  4. #include "crypt_des.h"
  5. static struct expanded_key __encrypt_key;
  6. void setkey(const char *key)
  7. {
  8. unsigned char bkey[8];
  9. int i, j;
  10. for (i = 0; i < 8; i++) {
  11. bkey[i] = 0;
  12. for (j = 7; j >= 0; j--, key++)
  13. bkey[i] |= (uint32_t)(*key & 1) << j;
  14. }
  15. __des_setkey(bkey, &__encrypt_key);
  16. }
  17. void encrypt(char *block, int edflag)
  18. {
  19. struct expanded_key decrypt_key, *key;
  20. uint32_t b[2];
  21. int i, j;
  22. char *p;
  23. p = block;
  24. for (i = 0; i < 2; i++) {
  25. b[i] = 0;
  26. for (j = 31; j >= 0; j--, p++)
  27. b[i] |= (uint32_t)(*p & 1) << j;
  28. }
  29. key = &__encrypt_key;
  30. if (edflag) {
  31. key = &decrypt_key;
  32. for (i = 0; i < 16; i++) {
  33. decrypt_key.l[i] = __encrypt_key.l[15-i];
  34. decrypt_key.r[i] = __encrypt_key.r[15-i];
  35. }
  36. }
  37. __do_des(b[0], b[1], b, b + 1, 1, 0, key);
  38. p = block;
  39. for (i = 0; i < 2; i++)
  40. for (j = 31; j >= 0; j--)
  41. *p++ = b[i]>>j & 1;
  42. }