giuliomoro@111: //scope.cpp
giuliomoro@112: #include <NetworkSend.h>
giuliomoro@111: 
giuliomoro@111: #define BUILD_FOR_UDPRECEIVE_PLUGIN
giuliomoro@111: #define NETWORK_AUDIO_BUFFER_SIZE 302
giuliomoro@111: 
giuliomoro@111: //initialize the static members of NetworkSend
giuliomoro@111: bool NetworkSend::staticConstructed=false;
giuliomoro@111: std::vector<NetworkSend*> NetworkSend::objAddrs(0);
giuliomoro@116: AuxiliaryTask NetworkSend::sendDataTask=NULL;
giuliomoro@111: 
giuliomoro@111: void transmitAudio(){
giuliomoro@111: 	NetworkSend::sendAllData();
giuliomoro@111: }
giuliomoro@111: 
giuliomoro@111: void NetworkSend::sendAllData(){
giuliomoro@111: 	for(unsigned int n=0; n<NetworkSend::objAddrs.size(); n++){
giuliomoro@111: 		NetworkSend::objAddrs[n]->sendData();
giuliomoro@111: 	}
giuliomoro@111: }
giuliomoro@111: 
giuliomoro@111: void NetworkSend::staticConstructor(){
giuliomoro@111: 	if(staticConstructed==true)
giuliomoro@111: 		return;
giuliomoro@111: 	staticConstructed=true;
giuliomoro@116: 	sendDataTask = BeagleRT_createAuxiliaryTask(transmitAudio, 95, "sendDataTask"); //TODO: allow variable priority
giuliomoro@111: };
giuliomoro@111: 
giuliomoro@111: NetworkSend::NetworkSend()
giuliomoro@111: {
giuliomoro@111: 	sampleCount = 0;
giuliomoro@111: 	channel.doneOnTime=true;
giuliomoro@111: 	channel.index=channel.headerLength; //leave space for the heading message (channel, timestamp)
giuliomoro@111: 	channel.activeBuffer=0;
giuliomoro@111: 	channel.readyToBeSent=false;
giuliomoro@111: }
giuliomoro@116: 
giuliomoro@111: NetworkSend::~NetworkSend(){
giuliomoro@111: 	for(unsigned int n=0; n<objAddrs.size(); n++){ //keep track of deleted instances;
giuliomoro@111: 		if(objAddrs[n]==this){
giuliomoro@111: 			objAddrs.erase(objAddrs.begin()+n);
giuliomoro@111: 			break;
giuliomoro@111: 		}
giuliomoro@111: 	}
giuliomoro@111: }
giuliomoro@111: 
giuliomoro@111: void NetworkSend::setup(float aSampleRate){
giuliomoro@111: 	setup(aSampleRate, 0, 9999, "192.168.7.1");//channelNumber=0
giuliomoro@111: }
giuliomoro@111: void NetworkSend::setup(float aSampleRate, int aChannelNumber, int aPort, const char *aServer){
giuliomoro@111: 	staticConstructor(); //FIXME: ideally this should be in the constructor, but this is not currently possible
giuliomoro@111: 						//because of limitations in BeagleRT_createAuxiliaryTask()
giuliomoro@111: 	//keep track of added active instances
giuliomoro@111: 	objAddrs.push_back(this);//TODO: this line should be in the constructor, but something weird happens if
giuliomoro@111: 	// an instance of NetworkSend is then declared globally: the constructor gets called,
giuliomoro@111: 	// and objAddrs.size()==1 but when you get to setup, objAddrs.size() has reverted back to 0, without
giuliomoro@111: 	// any destructor being called in between ...
giuliomoro@111: 	setChannelNumber(aChannelNumber);
giuliomoro@111: 	setPort(aPort);
giuliomoro@111: 	setServer(aServer);
giuliomoro@120: 	printf("Channel %d is sending messages to: %s:%d at %fHz\n", getChannelNumber(), aServer, aPort, aSampleRate);
giuliomoro@111: }
giuliomoro@111: 
giuliomoro@111: void NetworkSend::log(float value){ //TODO: add a vectorized version of this method
giuliomoro@111: 	if(channel.index==(NETWORK_AUDIO_BUFFER_SIZE)){ // when the buffer is ready ...
giuliomoro@111: 		channel.readyToBeSent=true;
giuliomoro@111: 		channel.index=channel.headerLength; //reset the counter
giuliomoro@111: 		if(channel.doneOnTime==false){
giuliomoro@111: 			printf("Network buffer underrun. timestamp: %d :-{\n", (int)channel.buffers[!channel.activeBuffer][1]);
giuliomoro@111: 		}
giuliomoro@111: 		channel.activeBuffer=!channel.activeBuffer; //switch buffer
giuliomoro@111: 		channel.doneOnTime=false;
giuliomoro@116: 		BeagleRT_scheduleAuxiliaryTask(NetworkSend::sendDataTask); //send the buffer
giuliomoro@120: 		// TODO: maybe we should have transmitAudioTask running in a loop instead of scheduling it multiple times?
giuliomoro@120: 		// The current solution allows to minimize latency when a single channel is used, as there is no inherent
giuliomoro@120: 		// rt_task_sleep in the thread, as we are signaling it every time.
giuliomoro@120: 		// Although, there is a possible race condition: if the auxiliaryTask is scheduled by channel 0,
giuliomoro@120: 		// it might still be executing when channel 1 schedules it. But if the AuxTask has already skipped
giuliomoro@120: 		// over channel 1, then we are at risk that channel 1 never gets sent.
giuliomoro@111: 	}
giuliomoro@111: 	if(channel.index==channel.headerLength){
giuliomoro@111: 		channel.buffers[channel.activeBuffer][0] = (float)channel.channelNumber; //TODO: this could actually be done just once in setup()
giuliomoro@111: 		channel.buffers[channel.activeBuffer][1]=(float)sampleCount; //timestamp
giuliomoro@111: 		//add here more header fields
giuliomoro@111: 	}
giuliomoro@111:     channel.buffers[channel.activeBuffer][channel.index++]=value;
giuliomoro@111: 	sampleCount++;
giuliomoro@111: };
giuliomoro@111: 
giuliomoro@111: void NetworkSend::setServer(const char *aServer){
giuliomoro@111: 	udpClient.setServer(aServer);
giuliomoro@111: }
giuliomoro@111: void NetworkSend::setPort(int aPort){
giuliomoro@111: 	udpClient.setPort(aPort);
giuliomoro@111: }
giuliomoro@111: 
giuliomoro@111: void NetworkSend::setChannelNumber(int aChannelNumber){
giuliomoro@111: 	channel.channelNumber=aChannelNumber;
giuliomoro@111: };
giuliomoro@111: int NetworkSend::getChannelNumber(){
giuliomoro@111: 	return channel.channelNumber;
giuliomoro@111: };
giuliomoro@111: 
giuliomoro@111: void NetworkSend::sendData(){
giuliomoro@111: 	if(channel.readyToBeSent){
giuliomoro@111: 		channel.readyToBeSent=false;
giuliomoro@111: 		udpClient.send(
giuliomoro@111: 			channel.buffers[!channel.activeBuffer],
giuliomoro@111: 			NETWORK_AUDIO_BUFFER_SIZE*sizeof(float)
giuliomoro@111: 		);
giuliomoro@111: 		channel.doneOnTime=true;
giuliomoro@111: 	}
giuliomoro@111: }
giuliomoro@111: 
giuliomoro@111: int NetworkSend::getNumInstances(){
giuliomoro@111: 	return objAddrs.size();
giuliomoro@111: };
giuliomoro@111: 
giuliomoro@111: Scope::Scope(int aNumChannels):
giuliomoro@111: 		channels(aNumChannels)
giuliomoro@111: {};
giuliomoro@111: Scope::~Scope(){};
giuliomoro@111: 
giuliomoro@111: void Scope::log(int channel, float value){
giuliomoro@111: 	if(channel>=getNumChannels()) //TODO: assert this
giuliomoro@111: 		return;
giuliomoro@111: 	channels[channel].log(value);
giuliomoro@111: }
giuliomoro@111: 
giuliomoro@111: void Scope::setup(){
giuliomoro@111: 	setup(44100, 9999, "127.0.0.1");
giuliomoro@111: }
giuliomoro@111: 
giuliomoro@111: void Scope::setup(float sampleRate, int aPort, const char* aServer){
giuliomoro@111: 	for(int n=0; n<getNumChannels(); n++){
giuliomoro@111: 		channels[n].setup(sampleRate, n, aPort, aServer);
giuliomoro@111: 	}
giuliomoro@111: }
giuliomoro@111: 
giuliomoro@119: void Scope::setPort(int port){
giuliomoro@119: 	for(int n=0; n<getNumChannels(); n++){
giuliomoro@119: 		channels[n].setPort(port);
giuliomoro@119: 	}
giuliomoro@119: }
giuliomoro@120: void Scope::setPort(int channel, int aPort){
giuliomoro@120: 	channels[channel].setPort(aPort);
giuliomoro@120: 	printf("Channel %d is now sending to port %d\n", channel, aPort);
giuliomoro@119: }
giuliomoro@119: 
giuliomoro@111: int Scope::getNumChannels(){
giuliomoro@111: 	return channels.size();
giuliomoro@111: }
giuliomoro@111: 
giuliomoro@111: void Scope::sendData(){
giuliomoro@111: 	NetworkSend::sendAllData();
giuliomoro@111: }