#include <wiringPi.h>
#include <softTone.h>
#include <stdio.h>
#include <unistd.h>

const int C    = 261;
const int Cis  = 277;
const int D    = 293;
const int Dis  = 311;
const int E    = 329;
const int F    = 349;
const int Fis  = 369;
const int G    = 391;
const int Gis  = 415;
const int A    = 440;
const int Ais  = 466;
const int H    = 493;
const int Takt = 1000;

void Beep(int freq, int length)
{
	softToneWrite(4, freq) ;
	usleep((1000000 / 1000) * length);
	softToneWrite(4, 0) ;
	usleep(10000);
}

int main()
{
	wiringPiSetup();
	printf("Entering Loop\n");
	printf("softtonereturns: %d\n",softToneCreate(4));
	while(1)
	{
		Beep(E * 2, Takt / 4);
        Beep(H * 1, Takt / 8);
        Beep(C * 2, Takt / 8);
        Beep(D * 2, Takt / 4);
        Beep(C * 2, Takt / 8);
        Beep(H * 1, Takt / 8);
        Beep(A * 1, Takt / 4);
        Beep(A * 1, Takt / 8);
        Beep(C * 2, Takt / 8);
        Beep(E * 2, Takt / 8);
        Beep(E * 2, Takt / 8);
        Beep(D * 2, Takt / 8);
        Beep(C * 2, Takt / 8);
        Beep(H * 1, Takt / 2.5);
        Beep(C * 2, Takt / 8);
        Beep(D * 2, Takt / 4);
        Beep(E * 2, Takt / 4);
        Beep(C * 2, Takt / 4);
        Beep(A * 1, Takt / 4);
        Beep(A * 1, Takt / 4);
        usleep((1000000 / 1000) * (Takt / ((float)8 / 3)));
        Beep(D * 2, Takt / 3.25);
        Beep(F * 2, Takt / 8);
        Beep(A * 2, Takt / 8);
        Beep(A * 2, Takt / 8);
        Beep(G * 2, Takt / 8);
        Beep(F * 2, Takt / 8);
        Beep(E * 2, Takt / 3);
        Beep(C * 2, Takt / 8);
        Beep(E * 2, Takt / 8);
        Beep(E * 2, Takt / 8);
        Beep(D * 2, Takt / 8);
        Beep(C * 2, Takt / 8);
        Beep(H * 1, Takt / 4);
        Beep(H * 1, Takt / 8);
        Beep(C * 2, Takt / 8);
        Beep(D * 2, Takt / 4);
        Beep(E * 2, Takt / 4);
        Beep(C * 2, Takt / 4);
        Beep(A * 1, Takt / 4);
        Beep(A * 1, Takt / 4);
	}
}
/*

printf("i = %d\n", i);
softToneWrite(4, i) ;
usleep(100000);
softToneWrite(4, 0) ;
usleep(1000000);

int i = 1;
for(i; i < 6000; i+=1)
{
	printf("i = %d\n", i);
	softToneWrite(4, i) ;
	usleep(30000);
}



*/