pwm.c 2.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Control PWM channels
  4. *
  5. * Copyright (c) 2020 SiFive, Inc
  6. * author: Pragnesh Patel <pragnesh.patel@sifive.com>
  7. */
  8. #include <command.h>
  9. #include <dm.h>
  10. #include <pwm.h>
  11. enum pwm_cmd {
  12. PWM_SET_INVERT,
  13. PWM_SET_CONFIG,
  14. PWM_SET_ENABLE,
  15. PWM_SET_DISABLE,
  16. };
  17. static int do_pwm(struct cmd_tbl *cmdtp, int flag, int argc,
  18. char *const argv[])
  19. {
  20. const char *str_cmd, *str_channel = NULL, *str_enable = NULL;
  21. const char *str_pwm = NULL, *str_period = NULL, *str_duty = NULL;
  22. enum pwm_cmd sub_cmd;
  23. struct udevice *dev;
  24. u32 channel, pwm_enable, pwm_dev, period_ns = 0, duty_ns = 0;
  25. int ret;
  26. if (argc < 4)
  27. return CMD_RET_USAGE;
  28. str_cmd = argv[1];
  29. argc -= 2;
  30. argv += 2;
  31. str_pwm = *argv;
  32. argc--;
  33. argv++;
  34. if (!str_pwm)
  35. return CMD_RET_USAGE;
  36. switch (*str_cmd) {
  37. case 'i':
  38. sub_cmd = PWM_SET_INVERT;
  39. if (argc != 2)
  40. return CMD_RET_USAGE;
  41. break;
  42. case 'c':
  43. sub_cmd = PWM_SET_CONFIG;
  44. if (argc != 3)
  45. return CMD_RET_USAGE;
  46. break;
  47. case 'e':
  48. sub_cmd = PWM_SET_ENABLE;
  49. if (argc != 1)
  50. return CMD_RET_USAGE;
  51. break;
  52. case 'd':
  53. sub_cmd = PWM_SET_DISABLE;
  54. if (argc != 1)
  55. return CMD_RET_USAGE;
  56. break;
  57. default:
  58. return CMD_RET_USAGE;
  59. }
  60. pwm_dev = dectoul(str_pwm, NULL);
  61. ret = uclass_get_device(UCLASS_PWM, pwm_dev, &dev);
  62. if (ret) {
  63. printf("pwm: '%s' not found\n", str_pwm);
  64. return cmd_process_error(cmdtp, ret);
  65. }
  66. str_channel = *argv;
  67. channel = dectoul(str_channel, NULL);
  68. argc--;
  69. argv++;
  70. if (sub_cmd == PWM_SET_INVERT) {
  71. str_enable = *argv;
  72. pwm_enable = dectoul(str_enable, NULL);
  73. ret = pwm_set_invert(dev, channel, pwm_enable);
  74. } else if (sub_cmd == PWM_SET_CONFIG) {
  75. str_period = *argv;
  76. argc--;
  77. argv++;
  78. period_ns = dectoul(str_period, NULL);
  79. str_duty = *argv;
  80. duty_ns = dectoul(str_duty, NULL);
  81. ret = pwm_set_config(dev, channel, period_ns, duty_ns);
  82. } else if (sub_cmd == PWM_SET_ENABLE) {
  83. ret = pwm_set_enable(dev, channel, 1);
  84. } else if (sub_cmd == PWM_SET_DISABLE) {
  85. ret = pwm_set_enable(dev, channel, 0);
  86. }
  87. if (ret) {
  88. printf("error(%d)\n", ret);
  89. return CMD_RET_FAILURE;
  90. }
  91. return CMD_RET_SUCCESS;
  92. }
  93. U_BOOT_CMD(pwm, 6, 0, do_pwm,
  94. "control pwm channels",
  95. "invert <pwm_dev_num> <channel> <polarity> - invert polarity\n"
  96. "pwm config <pwm_dev_num> <channel> <period_ns> <duty_ns> - config PWM\n"
  97. "pwm enable <pwm_dev_num> <channel> - enable PWM output\n"
  98. "pwm disable <pwm_dev_num> <channel> - eisable PWM output\n"
  99. "Note: All input values are in decimal");