sound.c 760 B

12345678910111213141516171819202122232425262728293031323334353637
  1. /*
  2. * Copyright (C) 2012 Samsung Electronics
  3. * R. Chandrasekar <rcsekar@samsung.com>
  4. *
  5. * SPDX-License-Identifier: GPL-2.0+
  6. */
  7. #include <common.h>
  8. #include <sound.h>
  9. void sound_create_square_wave(unsigned short *data, int size, uint32_t freq)
  10. {
  11. const int sample = 48000;
  12. const unsigned short amplitude = 16000; /* between 1 and 32767 */
  13. const int period = freq ? sample / freq : 0;
  14. const int half = period / 2;
  15. assert(freq);
  16. /* Make sure we don't overflow our buffer */
  17. if (size % 2)
  18. size--;
  19. while (size) {
  20. int i;
  21. for (i = 0; size && i < half; i++) {
  22. size -= 2;
  23. *data++ = amplitude;
  24. *data++ = amplitude;
  25. }
  26. for (i = 0; size && i < period - half; i++) {
  27. size -= 2;
  28. *data++ = -amplitude;
  29. *data++ = -amplitude;
  30. }
  31. }
  32. }