375 lines
7.6 KiB
C++
375 lines
7.6 KiB
C++
/****************************************************************************
|
|
* 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;
|
|
}
|