nuttx-apps/examples/audio_rttl/audio_rttl.cxx

/****************************************************************************
 * audio_rttl/audio_rttl.cxx
 *
 *   Copyright 2019 Sony Semiconductor Solutions Corporation
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in
 *    the documentation and/or other materials provided with the
 *    distribution.
 * 3. Neither the name of Sony Semiconductor Solutions Corporation nor
 *    the names of its contributors may be used to endorse or promote
 *    products derived from this software without specific prior written
 *    permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
 * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
 * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 *
 ****************************************************************************/

/****************************************************************************
 * Included Files
 ****************************************************************************/

#include <stdio.h>
#include <math.h>
#include <string.h>
#include <arch/board/board.h>
#include <arch/chip/audio.h>

#include "audio_rttl.h"

/****************************************************************************
 * Private Types
 ****************************************************************************/

/* Note - note freq on octave 1 */

#define C 16.35
#define CD 17.32
#define D 18.35
#define DE 19.45
#define E 20.60
#define F 21.83
#define FG 23.12
#define G 24.50
#define A 27.50
#define AB 29.14
#define B 30.84

/* Octave - base freq multiplier for the base freq */

#define OCT2 4
#define OCT3 8
#define OCT4 16
#define OCT5 32
#define OCT6 64
#define OCT7 128
#define OCT8 256

/****************************************************************************
 * Public Functions
 ****************************************************************************/

extern "C" int main(int argc, FAR char *argv[])
{
  int freq;
  float base_freq;
  char temp_note;
  int octave;
  int duration;
  int note_duration;
  int base_duration;
  int bpm;
  int cnt;

  /* Set I/O parameters for power on. */

  if (!board_audio_power_control(true))
    {
      printf("Error: board_audio_power_control() failure.\n");
      return 1;
    }

  printf("Start Audio RTTL player\n");

  bpm = 0;
  octave = 0;
  base_duration = 0;
  note_duration = 0;

  while (*g_song != ':')
    {
      g_song++;
    }

  g_song++;

  if (*g_song == 'd')
    {
      g_song = g_song + 2;
      base_duration = *g_song - '0';
      g_song++;
      if ((*g_song >= '0') && (*g_song <= '9'))
        {
          base_duration = (base_duration * 10) + (*g_song - '0');
          g_song++;
        }

      g_song++;
    }

  if (*g_song == 'o')
    {
      g_song = g_song + 2;
      octave = *g_song - '0';
      g_song = g_song + 2;
    }

  if (octave == 2)
    {
      octave = OCT2;
    }
  else if (octave == 3)
    {
      octave = OCT3;
    }
  else if (octave == 4)
    {
      octave = OCT4;
    }
  else if (octave == 5)
    {
      octave = OCT5;
    }
  else if (octave == 6)
    {
      octave = OCT6;
    }
  else if (octave == 7)
    {
      octave = OCT7;
    }
  else if (octave == 8)
    {
      octave = OCT8;
    }

  if (*g_song == 'b')
    {
      g_song = g_song + 2;
      bpm = 0;
      for (cnt = 1; cnt <= 3; cnt++)
        {
          if (*g_song != ':')
            {
              bpm = bpm * 10 + (*g_song - '0');
              g_song++;
            }

        }

      g_song++;
    }

  do
    {
      if ((*g_song >= '0') && (*g_song <= '9'))
        {
          note_duration = *g_song - '0';
          g_song++;
        }

      if ((*g_song >= '0') && (*g_song <= '9'))
        {
          note_duration = (note_duration * 10) + (*g_song - '0');
          g_song++;
        }

      if (note_duration > 0)
        {
          duration = ((60 * 1000L / bpm) * 4) / note_duration;
        }
      else
        {
          duration = ((60 * 1000L / bpm) * 4) / base_duration;
        }

      base_freq = 0;
      temp_note = ' ';
      switch (*g_song)
        {
        case 'c':
          {
            temp_note = 'c';
            base_freq = C;
            break;
          }

        case 'd':
          {
            temp_note = 'd';
            base_freq = D;
            break;
          }

        case 'e':
          {
            temp_note = 'e';
            base_freq = E;
            break;
          }

        case 'f':
          {
            temp_note = 'f';
            base_freq = F;
            break;
          }

        case 'g':
          {
            temp_note = 'g';
            base_freq = G;
            break;
          }

        case 'a':
          {
            temp_note = 'a';
            base_freq = A;
            break;
          }

        case 'b':
          {
            temp_note = 'b';
            base_freq = B;
            break;
          }

        case 'p':
          {
            temp_note = 'p';
            break;
          }

        default:
          break;
        }

      g_song++;

      if (*g_song == '.')
        {
          duration += duration / 2;
          g_song++;
        }

      if (*g_song == '#')
        {
          if (temp_note == 'c')
            {
              base_freq = CD;
            }

          if (temp_note == 'd')
            {
              base_freq = DE;
            }

          if (temp_note == 'f')
            {
              base_freq = FG;
            }

          if (temp_note == 'a')
            {
              base_freq = AB;
            }

          g_song++;
        }

      if ((*g_song - '0') == '2')
        {
          octave = OCT2;
        }

      if ((*g_song - '0') == '3')
        {
          octave = OCT3;
        }

      if ((*g_song - '0') == '4')
        {
          octave = OCT4;
        }

      if ((*g_song - '0') == '5')
        {
          octave = OCT5;
        }

      if ((*g_song - '0') == '6')
        {
          octave = OCT6;
        }

      if ((*g_song - '0') == '7')
        {
          octave = OCT7;
        }

      if ((*g_song - '0') == '8')
        {
          octave = OCT8;
        }

      g_song++;

      if (*g_song == ',')
        {
          g_song++;
        }

      /* play the sound */

      freq = ceil(base_freq * octave);

      if (!board_audio_tone_generator(1, -40, freq))
        {
          break;
        }

      usleep(duration * 1000L);
    }
  while (*g_song);

  /* Sound off. */

  if (!board_audio_tone_generator(0, 0, 0))
    {
      printf("Error: board_audio_tone_generator() failure.\n");
      return 1;
    }

  /* Set I/O parameters for power off. */

  if (!board_audio_power_control(false))
    {
      printf("Error: board_audio_power_control() failure.\n");
      return 1;
    }

  printf("Done.\n");

  return 0;
}