sound-uclass.c 3.7 KB

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