adc.c 3.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (C) 2018 BayLibre, SAS
  4. * Author: Neil Armstrong <narmstrong@baylibre.com>
  5. */
  6. #include <common.h>
  7. #include <command.h>
  8. #include <dm.h>
  9. #include <adc.h>
  10. static int do_adc_list(struct cmd_tbl *cmdtp, int flag, int argc,
  11. char *const argv[])
  12. {
  13. struct udevice *dev;
  14. int ret, err;
  15. ret = err = uclass_first_device_check(UCLASS_ADC, &dev);
  16. while (dev) {
  17. printf("- %s status: %i\n", dev->name, ret);
  18. ret = uclass_next_device_check(&dev);
  19. if (ret)
  20. err = ret;
  21. }
  22. return err ? CMD_RET_FAILURE : CMD_RET_SUCCESS;
  23. }
  24. static int do_adc_info(struct cmd_tbl *cmdtp, int flag, int argc,
  25. char *const argv[])
  26. {
  27. struct udevice *dev;
  28. unsigned int data_mask, ch_mask;
  29. int ret, vss, vdd;
  30. if (argc < 2)
  31. return CMD_RET_USAGE;
  32. ret = uclass_get_device_by_name(UCLASS_ADC, argv[1], &dev);
  33. if (ret) {
  34. printf("Unknown ADC device %s\n", argv[1]);
  35. return CMD_RET_FAILURE;
  36. }
  37. printf("ADC Device '%s' :\n", argv[1]);
  38. ret = adc_channel_mask(dev, &ch_mask);
  39. if (!ret)
  40. printf("channel mask: %x\n", ch_mask);
  41. ret = adc_data_mask(dev, &data_mask);
  42. if (!ret)
  43. printf("data mask: %x\n", data_mask);
  44. ret = adc_vdd_value(dev, &vdd);
  45. if (!ret)
  46. printf("vdd: %duV\n", vdd);
  47. ret = adc_vss_value(dev, &vss);
  48. if (!ret)
  49. printf("vss: %duV\n", vss);
  50. return CMD_RET_SUCCESS;
  51. }
  52. static int do_adc_single(struct cmd_tbl *cmdtp, int flag, int argc,
  53. char *const argv[])
  54. {
  55. char *varname = NULL;
  56. struct udevice *dev;
  57. unsigned int data;
  58. int ret, uV, val;
  59. if (argc < 3)
  60. return CMD_RET_USAGE;
  61. if (argc >= 4)
  62. varname = argv[3];
  63. ret = adc_channel_single_shot(argv[1], simple_strtol(argv[2], NULL, 0),
  64. &data);
  65. if (ret) {
  66. printf("Error getting single shot for device %s channel %s (ret=%d)\n",
  67. argv[1], argv[2], ret);
  68. return CMD_RET_FAILURE;
  69. }
  70. ret = uclass_get_device_by_name(UCLASS_ADC, argv[1], &dev);
  71. if (!ret && !adc_raw_to_uV(dev, data, &uV)) {
  72. val = uV;
  73. printf("%u, %d uV\n", data, uV);
  74. } else {
  75. val = data;
  76. printf("%u\n", data);
  77. }
  78. if (varname)
  79. env_set_ulong(varname, val);
  80. return CMD_RET_SUCCESS;
  81. }
  82. static int do_adc_scan(struct cmd_tbl *cmdtp, int flag, int argc,
  83. char *const argv[])
  84. {
  85. struct adc_channel ch[ADC_MAX_CHANNEL];
  86. struct udevice *dev;
  87. unsigned int ch_mask;
  88. int i, chan, ret, uV;
  89. if (argc < 2)
  90. return CMD_RET_USAGE;
  91. ret = uclass_get_device_by_name(UCLASS_ADC, argv[1], &dev);
  92. if (ret) {
  93. pr_err("Can't get the ADC %s: %d\n", argv[1], ret);
  94. return CMD_RET_FAILURE;
  95. }
  96. switch (argc) {
  97. case 3:
  98. ch_mask = simple_strtoul(argv[2], NULL, 0);
  99. if (ch_mask)
  100. break;
  101. case 2:
  102. ret = adc_channel_mask(dev, &ch_mask);
  103. if (ret) {
  104. pr_err("Can't get mask for %s: %d\n", dev->name, ret);
  105. return CMD_RET_FAILURE;
  106. }
  107. break;
  108. }
  109. ret = adc_channels_single_shot(dev->name, ch_mask, ch);
  110. if (ret) {
  111. pr_err("Can't get single shot for %s (chans mask: 0x%x): %d\n",
  112. dev->name, ch_mask, ret);
  113. return CMD_RET_FAILURE;
  114. }
  115. for (chan = 0, i = 0; chan < ADC_MAX_CHANNEL; chan++) {
  116. if (!(ch_mask & ADC_CHANNEL(chan)))
  117. continue;
  118. if (!adc_raw_to_uV(dev, ch[i].data, &uV))
  119. printf("[%02d]: %u, %d uV\n", ch[i].id, ch[i].data, uV);
  120. else
  121. printf("[%02d]: %u\n", ch[i].id, ch[i].data);
  122. i++;
  123. }
  124. return CMD_RET_SUCCESS;
  125. }
  126. static char adc_help_text[] =
  127. "list - list ADC devices\n"
  128. "adc info <name> - Get ADC device info\n"
  129. "adc single <name> <channel> [varname] - Get Single data of ADC device channel\n"
  130. "adc scan <name> [channel mask] - Scan all [or masked] ADC channels";
  131. U_BOOT_CMD_WITH_SUBCMDS(adc, "ADC sub-system", adc_help_text,
  132. U_BOOT_SUBCMD_MKENT(list, 1, 1, do_adc_list),
  133. U_BOOT_SUBCMD_MKENT(info, 2, 1, do_adc_info),
  134. U_BOOT_SUBCMD_MKENT(single, 4, 1, do_adc_single),
  135. U_BOOT_SUBCMD_MKENT(scan, 3, 1, do_adc_scan));