ITANetAudioMessage.cpp 10.9 KB
Newer Older
Anne's avatar
Anne committed
1
#include <ITANetAudioMessage.h>
Anne's avatar
Anne committed
2
3
4
5
#include <ITAStringUtils.h>

#include <VistaInterProcComm/Connections/VistaConnectionIP.h>
#include <VistaBase/VistaExceptionBase.h>
6
#include <VistaBase/VistaStreamUtils.h>
Anne's avatar
Anne committed
7
#include <ITAClock.h>
8
9
10

#include <cstring>
#include <algorithm>
Anne's avatar
Anne committed
11
#include <cassert>
12
13
#include <iostream>
#include <iomanip>
Anne's avatar
Anne committed
14
15
16

static int S_nMessageIds = 0;

17
18
19
20
CITANetAudioMessage::CITANetAudioMessage( VistaSerializingToolset::ByteOrderSwapBehavior bSwapBuffers )
	: m_vecIncomingBuffer( 2048 )
	, m_oOutgoing( 2048 )
	, m_pConnection( NULL )
Anne's avatar
Anne committed
21
{
22
23
	m_oOutgoing.SetByteorderSwapFlag( bSwapBuffers );
	m_oIncoming.SetByteorderSwapFlag( bSwapBuffers );
Anne's avatar
Anne committed
24
25
26
27
28
	ResetMessage();
}

void CITANetAudioMessage::ResetMessage()
{
29
	if( m_oIncoming.GetTailSize() > 0 )
Anne's avatar
Anne committed
30
		//vstr::err() << "CITANetAudioMessage::ResetMessage() called before message was fully processed!" << std::endl;
Anne's avatar
Anne committed
31
32
33
34

	// wait till sending is complete -> this prevents us
	// from deleting the buffer while it is still being read
	// by the connection
35
36
	if( m_pConnection )
		m_pConnection->WaitForSendFinish();
Anne's avatar
Anne committed
37
38
39
40

	m_nMessageId = S_nMessageIds++;

	m_oOutgoing.ClearBuffer();
41
42
43
	m_oOutgoing.WriteInt32( 0 ); // Payload size
	m_oOutgoing.WriteInt32( 0 ); // Message Type
	m_oOutgoing.WriteInt32( 0 ); // Identifier
Anne's avatar
Anne committed
44

45
	m_oIncoming.SetBuffer( NULL, 0 );
Anne's avatar
Anne committed
46

Anne's avatar
Anne committed
47
	m_nMessageType = -1;
Anne's avatar
Anne committed
48

Anne's avatar
Anne committed
49
	//m_pConnection = NULL;
50

Anne's avatar
Anne committed
51
#if NET_AUDIO_SHOW_TRAFFIC
52
	vstr::out() << "CITANetAudioMessage [Preparing] (id=" << std::setw( 4 ) << m_nMessageId << ")" << std::endl;
53
#endif
Anne's avatar
Anne committed
54
55
}

56
void CITANetAudioMessage::SetConnection( VistaConnectionIP* pConn )
Anne's avatar
Anne committed
57
58
59
60
61
62
{
	m_pConnection = pConn;
}

void CITANetAudioMessage::WriteMessage()
{
63
	VistaType::byte* pBuffer = ( VistaType::byte* ) m_oOutgoing.GetBuffer();
Anne's avatar
Anne committed
64
65
66
	VistaType::sint32 iSwapDummy;

	// rewrite size dummy
67
68
69
	iSwapDummy = m_oOutgoing.GetBufferSize() - sizeof( VistaType::sint32 );
	if( m_oOutgoing.GetByteorderSwapFlag() )
		VistaSerializingToolset::Swap4( &iSwapDummy );
Dipl.-Ing. Jonas Stienen's avatar
Dipl.-Ing. Jonas Stienen committed
70
	std::memcpy( pBuffer, &iSwapDummy, sizeof( VistaType::sint32 ) );
Anne's avatar
Anne committed
71

72
	pBuffer += sizeof( VistaType::sint32 );
Anne's avatar
Anne committed
73
74
75

	// rewrite type dummy
	iSwapDummy = m_nMessageType;
76
77
	if( m_oOutgoing.GetByteorderSwapFlag() )
		VistaSerializingToolset::Swap4( &iSwapDummy );
Dipl.-Ing. Jonas Stienen's avatar
Dipl.-Ing. Jonas Stienen committed
78
	std::memcpy( pBuffer, &iSwapDummy, sizeof( VistaType::sint32 ) );
79

80
	pBuffer += sizeof( VistaType::sint32 );
Anne's avatar
Anne committed
81
82
83

	// rewrite messageid dummy
	iSwapDummy = m_nMessageId;
84
85
	if( m_oOutgoing.GetByteorderSwapFlag() )
		VistaSerializingToolset::Swap4( &iSwapDummy );
Dipl.-Ing. Jonas Stienen's avatar
Dipl.-Ing. Jonas Stienen committed
86
	std::memcpy( pBuffer, &iSwapDummy, sizeof( VistaType::sint32 ) );
87

Anne's avatar
Anne committed
88
#if NET_AUDIO_SHOW_TRAFFIC
89
	vstr::out() << "CITANetAudioMessage [  Writing] " << m_nMessageType << " (id=" << std::setw( 4 ) << m_nMessageId << ")" << std::endl;
90
#endif
Anne's avatar
Anne committed
91

92
	try
Anne's avatar
Anne committed
93
	{
94
		// It appears safe to send even very big data payload, so we will send at once
Anne's avatar
Anne committed
95
		int iRawBufferSize = m_oOutgoing.GetBufferSize();
96
97
		int nRet = m_pConnection->Send( m_oOutgoing.GetBuffer(), iRawBufferSize );

Anne's avatar
Anne committed
98
#if NET_AUDIO_SHOW_TRAFFIC
99
		vstr::out() << "CITANetAudioMessage [  Writing] " << m_nMessageType << " (id=" << std::setw( 4 ) << m_nMessageId << ") RAW BUFFER DONE" << std::endl;
100
101
#endif

102
103
104
		m_pConnection->WaitForSendFinish();
		if( nRet != m_oOutgoing.GetBufferSize() )
			VISTA_THROW( "ITANetAudioMessage: could not send all data from output buffer via network connection", 255 );
Anne's avatar
Anne committed
105
	}
106
	catch (VistaExceptionBase& ex)
Anne's avatar
Anne committed
107
	{
108
		ITA_EXCEPT1( NETWORK_ERROR, ex.GetExceptionText() );
Anne's avatar
Anne committed
109
110
111
112
	}
}


Anne's avatar
Anne committed
113
bool CITANetAudioMessage::ReadMessage( int timeout)
Anne's avatar
Anne committed
114
{
Anne's avatar
Anne committed
115
#if NET_AUDIO_SHOW_TRAFFIC
116
	vstr::out() << "CITANetAudioMessage [ Reading ] Waiting for incoming data" << std::endl;
Anne's avatar
Anne committed
117
#endif
Anne's avatar
Anne committed
118
119
	double dTimeBefore = ITAClock::getDefaultClock( )->getTime( );
	// WaitForIncomming Data int in ca ms
Anne's avatar
Anne committed
120
	long nIncomingBytes = m_pConnection->WaitForIncomingData( timeout );
Anne's avatar
Anne committed
121
122
123
	double dTimeAfter = ITAClock::getDefaultClock( )->getTime( );
	double DTimeDiff = dTimeAfter - dTimeBefore;
	// TODO Timer entfernen
Anne's avatar
Anne committed
124
	if ( nIncomingBytes == -1)
Anne's avatar
Anne committed
125
		return false;
Anne's avatar
Anne committed
126

127
128
	if (timeout != 0)
		nIncomingBytes = m_pConnection->WaitForIncomingData( 0 );
Anne's avatar
Anne committed
129
#if NET_AUDIO_SHOW_TRAFFIC
130
	vstr::out() << "CITANetAudioMessage [ Reading ] " << nIncomingBytes << " bytes incoming" << std::endl;
Anne's avatar
Anne committed
131
#endif
132

133
134
	VistaType::sint32 nMessagePayloadSize;
	int nBytesRead = m_pConnection->ReadInt32( nMessagePayloadSize );
135
	assert( nBytesRead == sizeof( VistaType::sint32 ) );
Anne's avatar
Anne committed
136
#if NET_AUDIO_SHOW_TRAFFIC
137
	vstr::out() << "CITANetAudioMessage [ Reading ] Expecting " << nMessagePayloadSize << " bytes message payload" << std::endl;
Anne's avatar
Anne committed
138
#endif
139
140
	if (nMessagePayloadSize <= 2 * sizeof(VistaType::sint32))
		int i = 34;
141
	// we need at least the two protocol ints
142
	//assert( nMessagePayloadSize >= 2 * sizeof( VistaType::sint32 ) );
Anne's avatar
Anne committed
143

144
145
	if( nMessagePayloadSize > ( int ) m_vecIncomingBuffer.size() )
		m_vecIncomingBuffer.resize( nMessagePayloadSize );
146
147
	
	// Receive all incoming data (potentially splitted)
148
	int iBytesReceivedTotal = 0;
Anne's avatar
Anne committed
149
	while( nMessagePayloadSize > iBytesReceivedTotal )
Anne's avatar
Anne committed
150
	{
Anne's avatar
Anne committed
151
		int iIncommingBytes = m_pConnection->WaitForIncomingData( 0 );
Anne's avatar
Anne committed
152
153
154
155
156
		int iBytesReceived;
		if ( nMessagePayloadSize < iIncommingBytes )
			iBytesReceived = m_pConnection->Receive( &m_vecIncomingBuffer[ iBytesReceivedTotal ], nMessagePayloadSize - iBytesReceivedTotal );
		else
			iBytesReceived = m_pConnection->Receive( &m_vecIncomingBuffer[ iBytesReceivedTotal ], iIncommingBytes );
157
		iBytesReceivedTotal += iBytesReceived;
158
#if NET_AUDIO_SHOW_TRAFFIC
159
		vstr::out() << "[ CITANetAudioMessage ] " << std::setw( 3 ) << std::floor( iBytesReceivedTotal / float( nMessagePayloadSize ) * 100.0f ) << "% transmitted" << std::endl;
Anne's avatar
Anne committed
160
#endif
Anne's avatar
Anne committed
161
162
	}

163
164
	// Transfer data into members
	m_oIncoming.SetBuffer( &m_vecIncomingBuffer[ 0 ], nMessagePayloadSize, false );
Anne's avatar
Anne committed
165
166
167
	m_nMessageType = ReadInt();
	m_nMessageId = ReadInt();

Anne's avatar
Anne committed
168
#if NET_AUDIO_SHOW_TRAFFIC
169
	vstr::out() << "CITANetAudioMessage [ Reading ] Finished receiving " << m_nMessageType << " (id=" << std::setw( 4 ) << m_nMessageId << ")" << std::endl;
170
#endif
171
	return true;
172
}
Anne's avatar
Anne committed
173
174
175
176
177
178

int CITANetAudioMessage::GetMessageType() const
{
	return m_nMessageType;
}

179
void CITANetAudioMessage::SetMessageType( int nType )
Anne's avatar
Anne committed
180
{
Anne's avatar
Anne committed
181
	//assert( m_nMessageType == CITANetAudioProtocol::NP_INVALID ); // should only be set once
Anne's avatar
Anne committed
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
	m_nMessageType = nType;
}

int CITANetAudioMessage::GetIncomingMessageSize() const
{
	return m_oIncoming.GetTailSize();
}

int CITANetAudioMessage::GetOutgoingMessageSize() const
{
	return m_oOutgoing.GetBufferSize();
}

bool CITANetAudioMessage::GetOutgoingMessageHasData() const
{
197
	return ( m_oOutgoing.GetBufferSize() > 4 * sizeof( VistaType::sint32 ) );
Anne's avatar
Anne committed
198
199
}

200
void CITANetAudioMessage::WriteString( const std::string& sValue )
Anne's avatar
Anne committed
201
{
202
203
	m_oOutgoing.WriteInt32( ( VistaType::sint32 )sValue.size() );
	if( !sValue.empty() ) m_oOutgoing.WriteString( sValue );
Anne's avatar
Anne committed
204
205
}

206
void CITANetAudioMessage::WriteInt( const int iValue )
Anne's avatar
Anne committed
207
{
208
	m_oOutgoing.WriteInt32( ( VistaType::sint32 )iValue );
Anne's avatar
Anne committed
209
210
}

211
void CITANetAudioMessage::WriteBool( const bool bValue )
Anne's avatar
Anne committed
212
{
213
	m_oOutgoing.WriteBool( bValue );
Anne's avatar
Anne committed
214
215
}

216
void CITANetAudioMessage::WriteFloat( const float fValue )
Anne's avatar
Anne committed
217
{
218
	m_oOutgoing.WriteFloat32( fValue );
Anne's avatar
Anne committed
219
220
}

221
void CITANetAudioMessage::WriteDouble( const double dValue )
Anne's avatar
Anne committed
222
{
223
	m_oOutgoing.WriteFloat64( dValue );
Anne's avatar
Anne committed
224
225
226
227
228
}

std::string CITANetAudioMessage::ReadString()
{
	VistaType::sint32 nSize;
229
230
	int nReturn = m_oIncoming.ReadInt32( nSize );
	assert( nReturn == sizeof( VistaType::sint32 ) );
Anne's avatar
Anne committed
231
232

	// Empty string?
233
	if( nSize == 0 ) return "";
Anne's avatar
Anne committed
234
235

	std::string sValue;
236
237
	nReturn = m_oIncoming.ReadString( sValue, nSize );
	assert( nReturn == nSize );
Anne's avatar
Anne committed
238
239
240
241
242
243
	return sValue;
}

int CITANetAudioMessage::ReadInt()
{
	VistaType::sint32 nValue;
244
245
246
247
	int nReturn = m_oIncoming.ReadInt32( nValue );
	if( nReturn == -1 )
		ITA_EXCEPT1( UNKNOWN, "Could not read integer value from incoming message" );
	assert( nReturn == sizeof( VistaType::sint32 ) );
Anne's avatar
Anne committed
248
249
250
251
252
253
	return nValue;
}

bool CITANetAudioMessage::ReadBool()
{
	bool bValue;
254
255
	int nReturn = m_oIncoming.ReadBool( bValue );
	assert( nReturn == sizeof( bool ) );
Anne's avatar
Anne committed
256
257
258
259
260
	return bValue;
}
float CITANetAudioMessage::ReadFloat()
{
	float fValue;
261
262
	int nReturn = m_oIncoming.ReadFloat32( fValue );
	assert( nReturn == sizeof( float ) );
Anne's avatar
Anne committed
263
264
265
266
267
	return fValue;
}
double CITANetAudioMessage::ReadDouble()
{
	double dValue;
268
269
	int nReturn = m_oIncoming.ReadFloat64( dValue );
	assert( nReturn == sizeof( double ) );
Anne's avatar
Anne committed
270
271
272
273
	return dValue;
}


274
void CITANetAudioMessage::WriteException( const ITAException& oException )
Anne's avatar
Anne committed
275
{
276
277
278
	WriteInt( oException.iErrorCode );
	WriteString( oException.sModule );
	WriteString( oException.sReason );
Anne's avatar
Anne committed
279
280
281
282
283
284
285
}

ITAException CITANetAudioMessage::ReadException()
{
	int iErrorCode = ReadInt();
	std::string sModule = ReadString();
	std::string sReason = ReadString();
286
	return ITAException( iErrorCode, sModule, sReason );
Anne's avatar
Anne committed
287
288
289
290
291
292
293
294
295
296
297
}

VistaConnectionIP* CITANetAudioMessage::GetConnection() const
{
	return m_pConnection;
}

void CITANetAudioMessage::ClearConnection() {
	m_pConnection = NULL;
}

298
void CITANetAudioMessage::WriteIntVector( const std::vector<int> viData )
Anne's avatar
Anne committed
299
{
300
301
302
303
	int iSize = ( int ) viData.size();
	WriteInt( iSize );
	for( int i = 0; i < iSize; i++ )
		WriteInt( viData[ i ] );
Anne's avatar
Anne committed
304
305
306
307
308
309
}

std::vector<int> CITANetAudioMessage::ReadIntVector()
{
	std::vector<int> viData;
	int iSize = ReadInt();
310
311
	for( int i = 0; i < iSize; i++ )
		viData.push_back( ReadInt() );
Anne's avatar
Anne committed
312
313
314
315
316
317
318
319
320

	return viData;
}

CITANetAudioProtocol::StreamingParameters CITANetAudioMessage::ReadStreamingParameters()
{
	CITANetAudioProtocol::StreamingParameters oParams;

	oParams.iChannels = ReadInt();
321
322
	oParams.dSampleRate = ReadDouble( );
	oParams.iBlockSize = ReadInt( );
Anne's avatar
Anne committed
323
	oParams.iRingBufferSize = ReadInt( );
Anne's avatar
Anne committed
324
325
326
327

	return oParams;
}

328
void CITANetAudioMessage::WriteStreamingParameters( const CITANetAudioProtocol::StreamingParameters & oParams )
Anne's avatar
Anne committed
329
{
330
331
332
	WriteInt( oParams.iChannels );
	WriteDouble( oParams.dSampleRate );
	WriteInt( oParams.iBlockSize );
Anne's avatar
Anne committed
333
	WriteInt( oParams.iRingBufferSize );
Anne's avatar
Anne committed
334
}
335
336
337
338

int CITANetAudioMessage::ReadRingBufferSize()
{
	return ReadInt();
339
340
341
}

void CITANetAudioMessage::WriteRingBufferSize( const int iBufferSize )
342
{
343
344
345
	WriteInt( iBufferSize );
}

346
347
int CITANetAudioMessage::ReadRingBufferFree()
{
348
349
350
351
352
353
354
355
356
	return ReadInt();
}

void CITANetAudioMessage::WriteRingBufferFree( const int iBufferFree )
{
	WriteInt( iBufferFree );
}

void CITANetAudioMessage::ReadSampleFrame( ITASampleFrame* pSampleFrame )
357
358
{
	int iChannels = ReadInt();
359
360
361
362
363
364
	int iSamples = ReadInt();

	if( pSampleFrame->channels() != iChannels || pSampleFrame->GetLength() != iSamples )
		pSampleFrame->init( iChannels, iSamples, false );

	for( int i = 0; i < iChannels; i++ )
365
	{
366
		for( int j = 0; j < iSamples; j++ )
367
		{
368
			( *pSampleFrame )[ i ][ j ] = ReadFloat();
369
370
		}
	}
371
372
373
}

void CITANetAudioMessage::WriteSampleFrame( ITASampleFrame* pSamples )
374
{
375
376
377
378
	WriteInt( pSamples->channels() );
	WriteInt( pSamples->GetLength() );

	for( int i = 0; i < pSamples->channels(); i++ )
379
	{
380
		for( int j = 0; j < pSamples->GetLength(); j++ )
381
		{
382
			WriteFloat( ( *pSamples )[ i ][ j ] );
383
384
		}
	}
385
386
}