rtc.c 3.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167
  1. // SPDX-License-Identifier: GPL-2.0+
  2. #include <common.h>
  3. #include <command.h>
  4. #include <dm.h>
  5. #include <hexdump.h>
  6. #include <i2c.h>
  7. #include <mapmem.h>
  8. #include <rtc.h>
  9. #define MAX_RTC_BYTES 32
  10. static int do_rtc_read(struct udevice *dev, int argc, char * const argv[])
  11. {
  12. u8 buf[MAX_RTC_BYTES];
  13. int reg, len, ret, r;
  14. if (argc < 2 || argc > 3)
  15. return CMD_RET_USAGE;
  16. reg = hextoul(argv[0], NULL);
  17. len = hextoul(argv[1], NULL);
  18. if (argc == 3) {
  19. u8 *addr;
  20. addr = map_sysmem(hextoul(argv[2], NULL), len);
  21. ret = dm_rtc_read(dev, reg, addr, len);
  22. unmap_sysmem(addr);
  23. if (ret) {
  24. printf("dm_rtc_read() failed: %d\n", ret);
  25. return CMD_RET_FAILURE;
  26. }
  27. return CMD_RET_SUCCESS;
  28. }
  29. while (len) {
  30. r = min_t(int, len, sizeof(buf));
  31. ret = dm_rtc_read(dev, reg, buf, r);
  32. if (ret) {
  33. printf("dm_rtc_read() failed: %d\n", ret);
  34. return CMD_RET_FAILURE;
  35. }
  36. print_buffer(reg, buf, 1, r, 0);
  37. len -= r;
  38. reg += r;
  39. }
  40. return CMD_RET_SUCCESS;
  41. }
  42. static int do_rtc_write(struct udevice *dev, int argc, char * const argv[])
  43. {
  44. u8 buf[MAX_RTC_BYTES];
  45. int reg, len, ret;
  46. const char *s;
  47. int slen;
  48. if (argc < 2 || argc > 3)
  49. return CMD_RET_USAGE;
  50. reg = hextoul(argv[0], NULL);
  51. if (argc == 3) {
  52. u8 *addr;
  53. len = hextoul(argv[1], NULL);
  54. addr = map_sysmem(hextoul(argv[2], NULL), len);
  55. ret = dm_rtc_write(dev, reg, addr, len);
  56. unmap_sysmem(addr);
  57. if (ret) {
  58. printf("dm_rtc_write() failed: %d\n", ret);
  59. return CMD_RET_FAILURE;
  60. }
  61. return CMD_RET_SUCCESS;
  62. }
  63. s = argv[1];
  64. slen = strlen(s);
  65. if (slen % 2) {
  66. printf("invalid hex string\n");
  67. return CMD_RET_FAILURE;
  68. }
  69. while (slen) {
  70. len = min_t(int, slen / 2, sizeof(buf));
  71. if (hex2bin(buf, s, len)) {
  72. printf("invalid hex string\n");
  73. return CMD_RET_FAILURE;
  74. }
  75. ret = dm_rtc_write(dev, reg, buf, len);
  76. if (ret) {
  77. printf("dm_rtc_write() failed: %d\n", ret);
  78. return CMD_RET_FAILURE;
  79. }
  80. s += 2 * len;
  81. slen -= 2 * len;
  82. }
  83. return CMD_RET_SUCCESS;
  84. }
  85. int do_rtc(struct cmd_tbl *cmdtp, int flag, int argc, char * const argv[])
  86. {
  87. static int curr_rtc;
  88. struct udevice *dev;
  89. int ret, idx;
  90. if (argc < 2)
  91. return CMD_RET_USAGE;
  92. argc--;
  93. argv++;
  94. if (!strcmp(argv[0], "list")) {
  95. struct uclass *uc;
  96. idx = 0;
  97. uclass_id_foreach_dev(UCLASS_RTC, dev, uc) {
  98. printf("RTC #%d - %s\n", idx++, dev->name);
  99. }
  100. if (!idx) {
  101. printf("*** no RTC devices available ***\n");
  102. return CMD_RET_FAILURE;
  103. }
  104. return CMD_RET_SUCCESS;
  105. }
  106. idx = curr_rtc;
  107. if (!strcmp(argv[0], "dev") && argc >= 2)
  108. idx = dectoul(argv[1], NULL);
  109. ret = uclass_get_device(UCLASS_RTC, idx, &dev);
  110. if (ret) {
  111. printf("Cannot find RTC #%d: err=%d\n", idx, ret);
  112. return CMD_RET_FAILURE;
  113. }
  114. if (!strcmp(argv[0], "dev")) {
  115. /* Show the existing or newly selected RTC */
  116. if (argc >= 2)
  117. curr_rtc = idx;
  118. printf("RTC #%d - %s\n", idx, dev->name);
  119. return CMD_RET_SUCCESS;
  120. }
  121. if (!strcmp(argv[0], "read"))
  122. return do_rtc_read(dev, argc - 1, argv + 1);
  123. if (!strcmp(argv[0], "write"))
  124. return do_rtc_write(dev, argc - 1, argv + 1);
  125. return CMD_RET_USAGE;
  126. }
  127. U_BOOT_CMD(
  128. rtc, 5, 0, do_rtc,
  129. "RTC subsystem",
  130. "list - show available rtc devices\n"
  131. "rtc dev [n] - show or set current rtc device\n"
  132. "rtc read <reg> <count> - read and display 8-bit registers starting at <reg>\n"
  133. "rtc read <reg> <count> <addr> - read 8-bit registers starting at <reg> to memory <addr>\n"
  134. "rtc write <reg> <hexstring> - write 8-bit registers starting at <reg>\n"
  135. "rtc write <reg> <count> <addr> - write from memory <addr> to 8-bit registers starting at <reg>\n"
  136. );