sound-uclass.c 3.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright 2018 Google LLC
  4. * Written by Simon Glass <sjg@chromium.org>
  5. */
  6. #include <common.h>
  7. #include <dm.h>
  8. #include <i2s.h>
  9. #include <sound.h>
  10. #define SOUND_BITS_IN_BYTE 8
  11. int sound_setup(struct udevice *dev)
  12. {
  13. struct sound_ops *ops = sound_get_ops(dev);
  14. if (!ops->setup)
  15. return 0;
  16. return ops->setup(dev);
  17. }
  18. int sound_play(struct udevice *dev, void *data, uint data_size)
  19. {
  20. struct sound_ops *ops = sound_get_ops(dev);
  21. if (!ops->play)
  22. return -ENOSYS;
  23. return ops->play(dev, data, data_size);
  24. }
  25. int sound_stop_play(struct udevice *dev)
  26. {
  27. struct sound_ops *ops = sound_get_ops(dev);
  28. if (!ops->play)
  29. return -ENOSYS;
  30. return ops->stop_play(dev);
  31. }
  32. int sound_start_beep(struct udevice *dev, int frequency_hz)
  33. {
  34. struct sound_ops *ops = sound_get_ops(dev);
  35. if (!ops->start_beep)
  36. return -ENOSYS;
  37. return ops->start_beep(dev, frequency_hz);
  38. }
  39. int sound_stop_beep(struct udevice *dev)
  40. {
  41. struct sound_ops *ops = sound_get_ops(dev);
  42. if (!ops->stop_beep)
  43. return -ENOSYS;
  44. return ops->stop_beep(dev);
  45. }
  46. int sound_beep(struct udevice *dev, int msecs, int frequency_hz)
  47. {
  48. struct sound_uc_priv *uc_priv = dev_get_uclass_priv(dev);
  49. struct i2s_uc_priv *i2s_uc_priv;
  50. unsigned short *data;
  51. uint data_size;
  52. int ret;
  53. ret = sound_setup(dev);
  54. if (ret && ret != -EALREADY)
  55. return ret;
  56. /* Try using the beep interface if available */
  57. ret = sound_start_beep(dev, frequency_hz);
  58. if (ret != -ENOSYS) {
  59. if (ret)
  60. return ret;
  61. mdelay(msecs);
  62. ret = sound_stop_beep(dev);
  63. return ret;
  64. }
  65. /* Buffer length computation */
  66. i2s_uc_priv = dev_get_uclass_priv(uc_priv->i2s);
  67. data_size = i2s_uc_priv->samplingrate * i2s_uc_priv->channels;
  68. data_size *= (i2s_uc_priv->bitspersample / SOUND_BITS_IN_BYTE);
  69. data = malloc(data_size);
  70. if (!data) {
  71. debug("%s: malloc failed\n", __func__);
  72. return -ENOMEM;
  73. }
  74. sound_create_square_wave(i2s_uc_priv->samplingrate, data, data_size,
  75. frequency_hz, i2s_uc_priv->channels);
  76. while (msecs >= 1000) {
  77. ret = sound_play(dev, data, data_size);
  78. msecs -= 1000;
  79. }
  80. if (msecs) {
  81. unsigned long size =
  82. (data_size * msecs) / (sizeof(int) * 1000);
  83. ret = sound_play(dev, data, size);
  84. }
  85. sound_stop_play(dev);
  86. free(data);
  87. return ret;
  88. }
  89. int sound_find_codec_i2s(struct udevice *dev)
  90. {
  91. struct sound_uc_priv *uc_priv = dev_get_uclass_priv(dev);
  92. struct ofnode_phandle_args args;
  93. ofnode node;
  94. int ret;
  95. /* First the codec */
  96. node = ofnode_find_subnode(dev_ofnode(dev), "codec");
  97. if (!ofnode_valid(node)) {
  98. debug("Failed to find /cpu subnode\n");
  99. return -EINVAL;
  100. }
  101. ret = ofnode_parse_phandle_with_args(node, "sound-dai",
  102. "#sound-dai-cells", 0, 0, &args);
  103. if (ret) {
  104. debug("Cannot find phandle: %d\n", ret);
  105. return ret;
  106. }
  107. ret = uclass_get_device_by_ofnode(UCLASS_AUDIO_CODEC, args.node,
  108. &uc_priv->codec);
  109. if (ret) {
  110. debug("Cannot find codec: %d\n", ret);
  111. return ret;
  112. }
  113. /* Now the i2s */
  114. node = ofnode_find_subnode(dev_ofnode(dev), "cpu");
  115. if (!ofnode_valid(node)) {
  116. debug("Failed to find /cpu subnode\n");
  117. return -EINVAL;
  118. }
  119. ret = ofnode_parse_phandle_with_args(node, "sound-dai",
  120. "#sound-dai-cells", 0, 0, &args);
  121. if (ret) {
  122. debug("Cannot find phandle: %d\n", ret);
  123. return ret;
  124. }
  125. ret = uclass_get_device_by_ofnode(UCLASS_I2S, args.node, &uc_priv->i2s);
  126. if (ret) {
  127. debug("Cannot find i2s: %d\n", ret);
  128. return ret;
  129. }
  130. debug("Probed sound '%s' with codec '%s' and i2s '%s'\n", dev->name,
  131. uc_priv->codec->name, uc_priv->i2s->name);
  132. return 0;
  133. }
  134. UCLASS_DRIVER(sound) = {
  135. .id = UCLASS_SOUND,
  136. .name = "sound",
  137. .per_device_auto_alloc_size = sizeof(struct sound_uc_priv),
  138. };