md5sum.c 3.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * (C) Copyright 2011
  4. * Joe Hershberger, National Instruments, joe.hershberger@ni.com
  5. *
  6. * (C) Copyright 2000
  7. * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
  8. */
  9. #include <common.h>
  10. #include <command.h>
  11. #include <mapmem.h>
  12. #include <u-boot/md5.h>
  13. #include <asm/io.h>
  14. /*
  15. * Store the resulting sum to an address or variable
  16. */
  17. static void store_result(const u8 *sum, const char *dest)
  18. {
  19. unsigned int i;
  20. if (*dest == '*') {
  21. u8 *ptr;
  22. ptr = (u8 *)simple_strtoul(dest + 1, NULL, 16);
  23. for (i = 0; i < 16; i++)
  24. *ptr++ = sum[i];
  25. } else {
  26. char str_output[33];
  27. char *str_ptr = str_output;
  28. for (i = 0; i < 16; i++) {
  29. sprintf(str_ptr, "%02x", sum[i]);
  30. str_ptr += 2;
  31. }
  32. env_set(dest, str_output);
  33. }
  34. }
  35. #ifdef CONFIG_MD5SUM_VERIFY
  36. static int parse_verify_sum(char *verify_str, u8 *vsum)
  37. {
  38. if (*verify_str == '*') {
  39. u8 *ptr;
  40. ptr = (u8 *)simple_strtoul(verify_str + 1, NULL, 16);
  41. memcpy(vsum, ptr, 16);
  42. } else {
  43. unsigned int i;
  44. char *vsum_str;
  45. if (strlen(verify_str) == 32)
  46. vsum_str = verify_str;
  47. else {
  48. vsum_str = env_get(verify_str);
  49. if (vsum_str == NULL || strlen(vsum_str) != 32)
  50. return 1;
  51. }
  52. for (i = 0; i < 16; i++) {
  53. char *nullp = vsum_str + (i + 1) * 2;
  54. char end = *nullp;
  55. *nullp = '\0';
  56. *(u8 *)(vsum + i) =
  57. simple_strtoul(vsum_str + (i * 2), NULL, 16);
  58. *nullp = end;
  59. }
  60. }
  61. return 0;
  62. }
  63. int do_md5sum(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
  64. {
  65. ulong addr, len;
  66. unsigned int i;
  67. u8 output[16];
  68. u8 vsum[16];
  69. int verify = 0;
  70. int ac;
  71. char * const *av;
  72. void *buf;
  73. if (argc < 3)
  74. return CMD_RET_USAGE;
  75. av = argv + 1;
  76. ac = argc - 1;
  77. if (strcmp(*av, "-v") == 0) {
  78. verify = 1;
  79. av++;
  80. ac--;
  81. if (ac < 3)
  82. return CMD_RET_USAGE;
  83. }
  84. addr = simple_strtoul(*av++, NULL, 16);
  85. len = simple_strtoul(*av++, NULL, 16);
  86. buf = map_sysmem(addr, len);
  87. md5_wd(buf, len, output, CHUNKSZ_MD5);
  88. unmap_sysmem(buf);
  89. if (!verify) {
  90. printf("md5 for %08lx ... %08lx ==> ", addr, addr + len - 1);
  91. for (i = 0; i < 16; i++)
  92. printf("%02x", output[i]);
  93. printf("\n");
  94. if (ac > 2)
  95. store_result(output, *av);
  96. } else {
  97. char *verify_str = *av++;
  98. if (parse_verify_sum(verify_str, vsum)) {
  99. printf("ERROR: %s does not contain a valid md5 sum\n",
  100. verify_str);
  101. return 1;
  102. }
  103. if (memcmp(output, vsum, 16) != 0) {
  104. printf("md5 for %08lx ... %08lx ==> ", addr,
  105. addr + len - 1);
  106. for (i = 0; i < 16; i++)
  107. printf("%02x", output[i]);
  108. printf(" != ");
  109. for (i = 0; i < 16; i++)
  110. printf("%02x", vsum[i]);
  111. printf(" ** ERROR **\n");
  112. return 1;
  113. }
  114. }
  115. return 0;
  116. }
  117. #else
  118. static int do_md5sum(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
  119. {
  120. unsigned long addr, len;
  121. unsigned int i;
  122. u8 output[16];
  123. void *buf;
  124. if (argc < 3)
  125. return CMD_RET_USAGE;
  126. addr = simple_strtoul(argv[1], NULL, 16);
  127. len = simple_strtoul(argv[2], NULL, 16);
  128. buf = map_sysmem(addr, len);
  129. md5_wd(buf, len, output, CHUNKSZ_MD5);
  130. unmap_sysmem(buf);
  131. printf("md5 for %08lx ... %08lx ==> ", addr, addr + len - 1);
  132. for (i = 0; i < 16; i++)
  133. printf("%02x", output[i]);
  134. printf("\n");
  135. if (argc > 3)
  136. store_result(output, argv[3]);
  137. return 0;
  138. }
  139. #endif
  140. #ifdef CONFIG_MD5SUM_VERIFY
  141. U_BOOT_CMD(
  142. md5sum, 5, 1, do_md5sum,
  143. "compute MD5 message digest",
  144. "address count [[*]sum]\n"
  145. " - compute MD5 message digest [save to sum]\n"
  146. "md5sum -v address count [*]sum\n"
  147. " - verify md5sum of memory area"
  148. );
  149. #else
  150. U_BOOT_CMD(
  151. md5sum, 4, 1, do_md5sum,
  152. "compute MD5 message digest",
  153. "address count [[*]sum]\n"
  154. " - compute MD5 message digest [save to sum]"
  155. );
  156. #endif