andrewm@71: //scope.cpp
andrewm@71: #include <BeagleRT.h> 
andrewm@71: #include <rtdk.h>
andrewm@71: #include <cmath>
andrewm@71: #include <UdpClient.h>
andrewm@71: 
giuliomoro@107: #define BUILD_FOR_UDPRECEIVE_PLUGIN
giuliomoro@107: #define NETWORK_AUDIO_BUFFER_SIZE 302
andrewm@71: struct networkAudio{
andrewm@71: 	int timestamp;
andrewm@71: 	int currentBuffer;
andrewm@71: 	int index;
andrewm@71: 	float buffers[2][NETWORK_AUDIO_BUFFER_SIZE]; 
andrewm@71: 	int doneOnTime;
andrewm@71: 	bool toBeSent;
andrewm@71: 	UdpClient udpClient;
andrewm@71: };
andrewm@71: 
andrewm@71: #define NUM_SCOPE_CHANNELS 6
andrewm@71: 
andrewm@71: static void SendScopeData();
andrewm@71: 
andrewm@71: class Scope {
andrewm@71:     int sampleCount; 
andrewm@71:     float sampleRate;
andrewm@71:     AuxiliaryTask scopeTask;
andrewm@71:   public:
andrewm@71:     int numChannels;
andrewm@71:     networkAudio channel[NUM_SCOPE_CHANNELS];
andrewm@71:     Scope(){
andrewm@71:         numChannels = NUM_SCOPE_CHANNELS;
andrewm@71:         sampleCount = 0;
giuliomoro@107: #ifdef BUILD_FOR_UDPRECEIVE_PLUGIN
giuliomoro@107:         char server[]="192.168.7.1";
giuliomoro@107: #else
giuliomoro@107:         char server[]="127.0.0.1";
giuliomoro@107: #endif /* BUILD_FOR_UDPRECEIVE_PLUGIN */
giuliomoro@107:         printf("Sending messages to : %s\n", server);
andrewm@71:         for(int n=0; n<numChannels; n++){
andrewm@71:             channel[n].doneOnTime=1;
giuliomoro@93:             channel[n].index=2; //leave space for the heading message (channel, timestamp)
andrewm@71:             channel[n].timestamp=0;
andrewm@71:             channel[n].currentBuffer=0;
andrewm@71:             channel[n].toBeSent=false;
giuliomoro@107:             channel[n].udpClient.setServer(server);
giuliomoro@93: #ifdef BUILD_FOR_UDPRECEIVE_PLUGIN
giuliomoro@93:             channel[n].udpClient.setPort(9999+n);
giuliomoro@93: #else
andrewm@71:             channel[n].udpClient.setPort(9999);
giuliomoro@93: #endif /* BUILD_FOR_UDPRECEIVE_PLUGIN */
andrewm@71:     	}
andrewm@71:     }
andrewm@71:     void setup(float _sampleRate);
andrewm@71:     void log(float channel1=0.0, float channel2=0.0, float channel3=0.0, float channel4=0.0, float channel5=0.0, float channel6=0.0){
andrewm@71:         
andrewm@71:         for(int j=0; j<numChannels; j++){
andrewm@71: 			if(channel[j].index==(NETWORK_AUDIO_BUFFER_SIZE)){ // when the buffer is ready ...
andrewm@71:               channel[j].buffers[channel[j].currentBuffer][0] = (float)j;
andrewm@71:               channel[j].buffers[channel[j].currentBuffer][1] = (float)channel[j].timestamp;
andrewm@71: 				channel[j].toBeSent=true;
andrewm@71: 				channel[j].index=2; //reset the counter
andrewm@71: 				if(channel[j].doneOnTime==0)
andrewm@71: 					rt_printf("Network buffer underrun :-{\n");
andrewm@71: 				channel[j].timestamp=sampleCount;
andrewm@71: 				channel[j].currentBuffer=!channel[j].currentBuffer; //switch buffer
andrewm@71: 				channel[j].doneOnTime=0;
andrewm@71: 				BeagleRT_scheduleAuxiliaryTask(scopeTask); //send the buffer
andrewm@71: 			}
andrewm@71: 		}
andrewm@71:       
andrewm@71:       	channel[0].buffers[channel[0].currentBuffer][channel[0].index++]=channel1;
andrewm@71:       	channel[1].buffers[channel[1].currentBuffer][channel[1].index++]=channel2;
andrewm@71:       	channel[2].buffers[channel[2].currentBuffer][channel[2].index++]=channel3;
andrewm@71:       	channel[3].buffers[channel[3].currentBuffer][channel[3].index++]=channel4;
andrewm@71:       	channel[4].buffers[channel[4].currentBuffer][channel[4].index++]=channel5;
andrewm@71:       	channel[5].buffers[channel[5].currentBuffer][channel[5].index++]=channel6;
andrewm@71: 
andrewm@71: 	sampleCount++;
andrewm@71:     }
andrewm@71: };
andrewm@71: 
andrewm@71: Scope* gOscilloscopeInstance;
andrewm@71: 
andrewm@71: void Scope::setup(float _sampleRate){
andrewm@71:     sampleRate = _sampleRate;
andrewm@71:     gOscilloscopeInstance = this;
andrewm@71:     scopeTask = BeagleRT_createAuxiliaryTask(*SendScopeData, 98, "transmit-receive-audio");
andrewm@71: }
andrewm@71: 
andrewm@71: //Scope scope; 
andrewm@71: 
andrewm@71: static void SendScopeData(){
andrewm@71:     for(int n=0; n<gOscilloscopeInstance->numChannels; n++){
andrewm@71: 		if(gOscilloscopeInstance->channel[n].toBeSent){
andrewm@71: 			gOscilloscopeInstance->channel[n].toBeSent=false;
giuliomoro@93: 			gOscilloscopeInstance->channel[n].udpClient.send(
giuliomoro@93: 				gOscilloscopeInstance->channel[n].buffers[!gOscilloscopeInstance->channel[n].currentBuffer],
giuliomoro@93: 				NETWORK_AUDIO_BUFFER_SIZE*sizeof(float)
giuliomoro@93: 			);
andrewm@71: 			gOscilloscopeInstance->channel[n].doneOnTime=1;
andrewm@71: 		}
andrewm@71: 	}
andrewm@71: }