giuliomoro@24: /*
giuliomoro@24:  * render.cpp
giuliomoro@24:  *
giuliomoro@24:  *  Created on: Oct 24, 2014
giuliomoro@24:  *      Author: parallels
giuliomoro@24:  */
giuliomoro@24: 
andrewm@56: #include <BeagleRT.h>
giuliomoro@92: //#include <rtdk.h>
giuliomoro@24: #include <cmath>
giuliomoro@92: #include <UdpClient.h>
giuliomoro@92: #include <Utilities.h>
giuliomoro@92: 
giuliomoro@92: AuxiliaryTask transmitReceiveDataTask;
giuliomoro@92: 
giuliomoro@92: #define NETWORK_AUDIO_BUFFER_SIZE 400 //1400/4 //maximum payload for a UDP datagram over ethernet is 1472 bytes, I leave some headroom and divide by 4 to get the number of floats
giuliomoro@92: struct networkAudio{
giuliomoro@92: 	int timestamp;
giuliomoro@92: 	int currentBuffer;
giuliomoro@92: 	int index;
giuliomoro@92: 	float buffers[2][NETWORK_AUDIO_BUFFER_SIZE];
giuliomoro@92: 	int doneOnTime;
giuliomoro@92: 	bool toBeSent;
giuliomoro@92: 	UdpClient udpClient;
giuliomoro@92: };
andrewm@56: 
giuliomoro@24: float gFrequency;
giuliomoro@24: float gPhase;
giuliomoro@24: float gInverseSampleRate;
giuliomoro@24: int gCount=0;
giuliomoro@92: //networkData networkObject;
giuliomoro@92: #define numNetAudio 3
giuliomoro@92: networkAudio netAudio[numNetAudio];
giuliomoro@92: AuxiliaryTask printIntervalTask;
giuliomoro@92: AuxiliaryTask transmitReceiveAudioTask;
giuliomoro@24: 
giuliomoro@92: void transmitReceiveAudio(){ //transmit and receive audio buffers
giuliomoro@92: 	for(int n=0;n<numNetAudio; n++){
giuliomoro@92: 		if(netAudio[n].toBeSent){
giuliomoro@92: 			netAudio[n].toBeSent=false;
giuliomoro@92: 			netAudio[n].udpClient.send(netAudio[n].buffers[!netAudio[n].currentBuffer],NETWORK_AUDIO_BUFFER_SIZE*sizeof(float));
giuliomoro@92: 			netAudio[n].doneOnTime=1;
giuliomoro@92: 		}
giuliomoro@24: 	}
giuliomoro@24: }
giuliomoro@24: 
andrewm@56: // setup() is called once before the audio rendering starts.
giuliomoro@24: // Use it to perform any initialisation and allocation which is dependent
giuliomoro@24: // on the period size or sample rate.
giuliomoro@24: //
giuliomoro@24: // userData holds an opaque pointer to a data structure that was passed
giuliomoro@24: // in from the call to initAudio().
giuliomoro@24: //
giuliomoro@24: // Return true on success; returning false halts the program.
andrewm@56: bool setup(BeagleRTContext *context, void *userData)
giuliomoro@24: {
giuliomoro@24: 	// Retrieve a parameter passed in from the initAudio() call
giuliomoro@24: 	gFrequency = *(float *)userData;
giuliomoro@24: 
andrewm@56: 	gInverseSampleRate = 1.0 / context->audioSampleRate;
giuliomoro@24: 	gPhase = 0.0;
giuliomoro@24: 
giuliomoro@92: //	networkObject.counter=&gCount;
giuliomoro@92: //	networkObject.variables[0]=&gFrequency;
giuliomoro@92: //	networkObject.variables[1]=&gPhase;
giuliomoro@92: //	networkObject.numVariables=2;
giuliomoro@92: 	for(int n=0; n<numNetAudio; n++){
giuliomoro@92: 		netAudio[n].doneOnTime=1;
giuliomoro@92: 		netAudio[n].index=0;
giuliomoro@92: 		netAudio[n].currentBuffer=0;
giuliomoro@92: 		netAudio[n].toBeSent=false;
giuliomoro@92: //		netAudio[n].udpClient.setPort(settings->transmitPort+n);
giuliomoro@92: //		netAudio[n].udpClient.setServer(settings->serverName);
giuliomoro@92: 		netAudio[n].udpClient.setPort(9999+n);
giuliomoro@92: 		netAudio[n].udpClient.setServer("192.168.7.1");
giuliomoro@92: 	}
giuliomoro@92: //	setupSockets(settings->receivePort, settings->transmitPort, settings->serverName);
giuliomoro@92: 
giuliomoro@92: //	transmitReceiveDataTask=createAuxiliaryTask(*transmitReceiveData, 10, "transmit-receive-data");
giuliomoro@92: //	scheduleAuxiliaryTask(transmitReceiveDataTask); //here it does not work
giuliomoro@92: 	transmitReceiveAudioTask=BeagleRT_createAuxiliaryTask(*transmitReceiveAudio, 98, "transmit-receive-audio");
giuliomoro@24: 	return true;
giuliomoro@24: }
giuliomoro@24: 
giuliomoro@24: // render() is called regularly at the highest priority by the audio engine.
giuliomoro@24: // Input and output are given from the audio hardware and the other
giuliomoro@24: // ADCs and DACs (if available). If only audio is available, numMatrixFrames
giuliomoro@24: // will be 0.
giuliomoro@24: 
andrewm@56: void render(BeagleRTContext *context, void *userData)
giuliomoro@92: {/*
andrewm@56: 	for(unsigned int n = 0; n < context->audioFrames; n++) {
giuliomoro@24: 		float out = 0.7f * sinf(gPhase);
giuliomoro@24: 		gPhase += 2.0 * M_PI * gFrequency * gInverseSampleRate;
giuliomoro@24: 		if(gPhase > 2.0 * M_PI)
giuliomoro@24: 			gPhase -= 2.0 * M_PI;
giuliomoro@24: 
andrewm@56: 		for(unsigned int channel = 0; channel < context->audioChannels; channel++)
andrewm@56: 			context->audioOut[n * context->audioChannels + channel] = out;
andrewm@56: 
andrewm@56: 		if(gCount == 0){
andrewm@56: 			BeagleRT_scheduleAuxiliaryTask(transmitReceiveDataTask);
giuliomoro@24: 		}
giuliomoro@24: 		gCount++;
giuliomoro@24: 	}
giuliomoro@92: 
giuliomoro@92: 
giuliomoro@92: */
giuliomoro@92: 	for(int n = 0; n < context->audioFrames; n++) {
giuliomoro@92: 		float out = 0.7f * sinf(gPhase);
giuliomoro@92: 		gPhase += 2.0 * M_PI * gFrequency * gInverseSampleRate;
giuliomoro@92: 		if(gPhase > 2.0 * M_PI)
giuliomoro@92: 			gPhase -= 2.0 * M_PI;
giuliomoro@92: 
giuliomoro@92: //		for(int channel = 0; channel < context->audioChannels; channel++)
giuliomoro@92: //			context->audioOut[n * context->audioChannels + channel] = context->audioIn[n * context->audioChannels + 0]+context->audioIn[n * context->audioChannels + 1];
giuliomoro@92: 		context->audioOut[n * context->audioChannels] = context->audioIn[n*context->audioChannels+0];
giuliomoro@92: 		context->audioOut[n * context->audioChannels+1]=out;
giuliomoro@92: 		if(0==gCount){
giuliomoro@92: //			scheduleAuxiliaryTask(transmitReceiveDataTask);
giuliomoro@92: 		}
giuliomoro@92: 		for(int j=0; j<numNetAudio; j++){
giuliomoro@92: 			if(netAudio[j].index==(NETWORK_AUDIO_BUFFER_SIZE)){ // when the buffer is ready ...
giuliomoro@92: 				netAudio[j].toBeSent=true;
giuliomoro@92: 				netAudio[j].index=0; //reset the counter
giuliomoro@92: 				if(netAudio[j].doneOnTime==0)
giuliomoro@92: 					rt_printf("Network buffer underrun :-{\n");
giuliomoro@92: 				netAudio[j].timestamp=gCount;
giuliomoro@92: 				netAudio[j].currentBuffer=!netAudio[j].currentBuffer; //switch buffer
giuliomoro@92: 				netAudio[j].doneOnTime=0;
giuliomoro@92: 				BeagleRT_scheduleAuxiliaryTask(transmitReceiveAudioTask); //send the buffer
giuliomoro@92: 			}
giuliomoro@92: 		}
giuliomoro@92: 		if((gCount&1)==0){
giuliomoro@92: 			netAudio[1].buffers[netAudio[1].currentBuffer][netAudio[1].index++]=analogReadFrame(context,n/2,0)+context->audioOut[n*context->audioChannels + 0];
giuliomoro@92: 			netAudio[2].buffers[netAudio[2].currentBuffer][netAudio[2].index++]=analogReadFrame(context,n/2,1)+context->audioOut[n*context->audioChannels + 0];
giuliomoro@92: 		}
giuliomoro@92: 		netAudio[0].buffers[netAudio[0].currentBuffer][netAudio[0].index++]=0.5*(out+context->audioOut[n*context->audioChannels + 0]);//copy channel 0 to the buffer
giuliomoro@92: //		netAudio[1].buffers[netAudio[1].currentBuffer][netAudio[1].index++]=0.5*(out+context->audioOut[n*context->audioChannels + 0]);
giuliomoro@92: //		netAudio[2].buffers[netAudio[2].currentBuffer][netAudio[2].index++]=0.5*(out+context->audioOut[n*context->audioChannels + 0]);
giuliomoro@92: 		gCount++;
giuliomoro@92: 	}
giuliomoro@24: }
giuliomoro@24: 
andrewm@56: // cleanup() is called once at the end, after the audio has stopped.
andrewm@56: // Release any resources that were allocated in setup().
giuliomoro@24: 
andrewm@56: void cleanup(BeagleRTContext *context, void *userData)
giuliomoro@24: {
giuliomoro@24: }