Blame channels/rdpsnd/server/rdpsnd_main.c

Packit 1fb8d4
/**
Packit 1fb8d4
 * FreeRDP: A Remote Desktop Protocol Implementation
Packit 1fb8d4
 * Server Audio Virtual Channel
Packit 1fb8d4
 *
Packit 1fb8d4
 * Copyright 2012 Vic Lee
Packit 1fb8d4
 * Copyright 2015 Thincast Technologies GmbH
Packit 1fb8d4
 * Copyright 2015 DI (FH) Martin Haimberger <martin.haimberger@thincast.com>
Packit 1fb8d4
 *
Packit 1fb8d4
 * Licensed under the Apache License, Version 2.0 (the "License");
Packit 1fb8d4
 * you may not use this file except in compliance with the License.
Packit 1fb8d4
 * You may obtain a copy of the License at
Packit 1fb8d4
 *
Packit 1fb8d4
 *	 http://www.apache.org/licenses/LICENSE-2.0
Packit 1fb8d4
 *
Packit 1fb8d4
 * Unless required by applicable law or agreed to in writing, software
Packit 1fb8d4
 * distributed under the License is distributed on an "AS IS" BASIS,
Packit 1fb8d4
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
Packit 1fb8d4
 * See the License for the specific language governing permissions and
Packit 1fb8d4
 * limitations under the License.
Packit 1fb8d4
 */
Packit 1fb8d4
Packit 1fb8d4
#ifdef HAVE_CONFIG_H
Packit 1fb8d4
#include "config.h"
Packit 1fb8d4
#endif
Packit 1fb8d4
Packit 1fb8d4
#include <stdio.h>
Packit 1fb8d4
#include <stdlib.h>
Packit 1fb8d4
#include <string.h>
Packit 1fb8d4
Packit 1fb8d4
#include <winpr/crt.h>
Packit 1fb8d4
#include <winpr/print.h>
Packit 1fb8d4
#include <winpr/stream.h>
Packit 1fb8d4
Packit 1fb8d4
#include <freerdp/channels/log.h>
Packit 1fb8d4
Packit 1fb8d4
#include "rdpsnd_common.h"
Packit 1fb8d4
#include "rdpsnd_main.h"
Packit 1fb8d4
Packit 1fb8d4
/**
Packit 1fb8d4
 * Function description
Packit 1fb8d4
 *
Packit 1fb8d4
 * @return 0 on success, otherwise a Win32 error code
Packit 1fb8d4
 */
Packit 1fb8d4
static UINT rdpsnd_server_send_formats(RdpsndServerContext* context, wStream* s)
Packit 1fb8d4
{
Packit 1fb8d4
	size_t pos;
Packit 1fb8d4
	UINT16 i;
Packit 1fb8d4
	BOOL status = FALSE;
Packit 1fb8d4
	ULONG written;
Packit 1fb8d4
	Stream_Write_UINT8(s, SNDC_FORMATS);
Packit 1fb8d4
	Stream_Write_UINT8(s, 0);
Packit 1fb8d4
	Stream_Seek_UINT16(s);
Packit Service 5a9772
	Stream_Write_UINT32(s, 0);                           /* dwFlags */
Packit Service 5a9772
	Stream_Write_UINT32(s, 0);                           /* dwVolume */
Packit Service 5a9772
	Stream_Write_UINT32(s, 0);                           /* dwPitch */
Packit Service 5a9772
	Stream_Write_UINT16(s, 0);                           /* wDGramPort */
Packit 1fb8d4
	Stream_Write_UINT16(s, context->num_server_formats); /* wNumberOfFormats */
Packit Service 5a9772
	Stream_Write_UINT8(s, context->block_no);            /* cLastBlockConfirmed */
Packit Service 5a9772
	Stream_Write_UINT16(s, CHANNEL_VERSION_WIN_MAX);     /* wVersion */
Packit Service 5a9772
	Stream_Write_UINT8(s, 0);                            /* bPad */
Packit 1fb8d4
Packit 1fb8d4
	for (i = 0; i < context->num_server_formats; i++)
Packit 1fb8d4
	{
Packit 1fb8d4
		AUDIO_FORMAT format = context->server_formats[i];
Packit 1fb8d4
		// TODO: Eliminate this!!!
Packit Service 5a9772
		format.nAvgBytesPerSec =
Packit Service 5a9772
		    format.nSamplesPerSec * format.nChannels * format.wBitsPerSample / 8;
Packit 1fb8d4
Packit 1fb8d4
		if (!audio_format_write(s, &format))
Packit 1fb8d4
			goto fail;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	pos = Stream_GetPosition(s);
Packit 1fb8d4
	Stream_SetPosition(s, 2);
Packit 1fb8d4
	Stream_Write_UINT16(s, pos - 4);
Packit 1fb8d4
	Stream_SetPosition(s, pos);
Packit Service 5a9772
	status = WTSVirtualChannelWrite(context->priv->ChannelHandle, (PCHAR)Stream_Buffer(s),
Packit Service 5a9772
	                                Stream_GetPosition(s), &written);
Packit 1fb8d4
	Stream_SetPosition(s, 0);
Packit 1fb8d4
fail:
Packit 1fb8d4
	return status ? CHANNEL_RC_OK : ERROR_INTERNAL_ERROR;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
/**
Packit 1fb8d4
 * Function description
Packit 1fb8d4
 *
Packit 1fb8d4
 * @return 0 on success, otherwise a Win32 error code
Packit 1fb8d4
 */
Packit Service 5a9772
static UINT rdpsnd_server_recv_waveconfirm(RdpsndServerContext* context, wStream* s)
Packit 1fb8d4
{
Packit 1fb8d4
	UINT16 timestamp;
Packit 1fb8d4
	BYTE confirmBlockNum;
Packit 1fb8d4
	UINT error = CHANNEL_RC_OK;
Packit 1fb8d4
Packit 1fb8d4
	if (Stream_GetRemainingLength(s) < 4)
Packit 1fb8d4
	{
Packit 1fb8d4
		WLog_ERR(TAG, "not enough data in stream!");
Packit 1fb8d4
		return ERROR_INVALID_DATA;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	Stream_Read_UINT16(s, timestamp);
Packit 1fb8d4
	Stream_Read_UINT8(s, confirmBlockNum);
Packit 1fb8d4
	Stream_Seek_UINT8(s);
Packit Service 5a9772
	IFCALLRET(context->ConfirmBlock, error, context, confirmBlockNum, timestamp);
Packit 1fb8d4
Packit 1fb8d4
	if (error)
Packit Service 5a9772
		WLog_ERR(TAG, "context->ConfirmBlock failed with error %" PRIu32 "", error);
Packit 1fb8d4
Packit 1fb8d4
	return error;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
/**
Packit 1fb8d4
 * Function description
Packit 1fb8d4
 *
Packit 1fb8d4
 * @return 0 on success, otherwise a Win32 error code
Packit 1fb8d4
 */
Packit Service 5a9772
static UINT rdpsnd_server_recv_quality_mode(RdpsndServerContext* context, wStream* s)
Packit 1fb8d4
{
Packit 1fb8d4
	UINT16 quality;
Packit 1fb8d4
Packit 1fb8d4
	if (Stream_GetRemainingLength(s) < 4)
Packit 1fb8d4
	{
Packit 1fb8d4
		WLog_ERR(TAG, "not enough data in stream!");
Packit 1fb8d4
		return ERROR_INVALID_DATA;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	Stream_Read_UINT16(s, quality);
Packit 1fb8d4
	Stream_Seek_UINT16(s); // reserved
Packit Service 5a9772
	WLog_DBG(TAG, "Client requested sound quality: 0x%04" PRIX16 "", quality);
Packit 1fb8d4
	return CHANNEL_RC_OK;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
/**
Packit 1fb8d4
 * Function description
Packit 1fb8d4
 *
Packit 1fb8d4
 * @return 0 on success, otherwise a Win32 error code
Packit 1fb8d4
 */
Packit 1fb8d4
static UINT rdpsnd_server_recv_formats(RdpsndServerContext* context, wStream* s)
Packit 1fb8d4
{
Packit 1fb8d4
	UINT16 i, num_known_format = 0;
Packit 1fb8d4
	UINT32 flags, vol, pitch;
Packit 1fb8d4
	UINT16 udpPort;
Packit 1fb8d4
	BYTE lastblock;
Packit 1fb8d4
	UINT error = CHANNEL_RC_OK;
Packit 1fb8d4
Packit 1fb8d4
	if (Stream_GetRemainingLength(s) < 20)
Packit 1fb8d4
	{
Packit 1fb8d4
		WLog_ERR(TAG, "not enough data in stream!");
Packit 1fb8d4
		return ERROR_INVALID_DATA;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit Service 5a9772
	Stream_Read_UINT32(s, flags);                       /* dwFlags */
Packit Service 5a9772
	Stream_Read_UINT32(s, vol);                         /* dwVolume */
Packit Service 5a9772
	Stream_Read_UINT32(s, pitch);                       /* dwPitch */
Packit Service 5a9772
	Stream_Read_UINT16(s, udpPort);                     /* wDGramPort */
Packit 1fb8d4
	Stream_Read_UINT16(s, context->num_client_formats); /* wNumberOfFormats */
Packit Service 5a9772
	Stream_Read_UINT8(s, lastblock);                    /* cLastBlockConfirmed */
Packit Service 5a9772
	Stream_Read_UINT16(s, context->clientVersion);      /* wVersion */
Packit Service 5a9772
	Stream_Seek_UINT8(s);                               /* bPad */
Packit 1fb8d4
Packit 1fb8d4
	/* this check is only a guess as cbSize can influence the size of a format record */
Packit 1fb8d4
	if (Stream_GetRemainingLength(s) < context->num_client_formats * 18)
Packit 1fb8d4
	{
Packit 1fb8d4
		WLog_ERR(TAG, "not enough data in stream!");
Packit 1fb8d4
		return ERROR_INVALID_DATA;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	if (!context->num_client_formats)
Packit 1fb8d4
	{
Packit Service 5a9772
		WLog_ERR(TAG, "client doesn't support any format!");
Packit 1fb8d4
		return ERROR_INTERNAL_ERROR;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	context->client_formats = audio_formats_new(context->num_client_formats);
Packit 1fb8d4
Packit 1fb8d4
	if (!context->client_formats)
Packit 1fb8d4
	{
Packit Service 5a9772
		WLog_ERR(TAG, "calloc failed!");
Packit 1fb8d4
		return CHANNEL_RC_NO_MEMORY;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	for (i = 0; i < context->num_client_formats; i++)
Packit 1fb8d4
	{
Packit 1fb8d4
		if (Stream_GetRemainingLength(s) < 18)
Packit 1fb8d4
		{
Packit 1fb8d4
			WLog_ERR(TAG, "not enough data in stream!");
Packit 1fb8d4
			error = ERROR_INVALID_DATA;
Packit 1fb8d4
			goto out_free;
Packit 1fb8d4
		}
Packit 1fb8d4
Packit 1fb8d4
		Stream_Read_UINT16(s, context->client_formats[i].wFormatTag);
Packit 1fb8d4
		Stream_Read_UINT16(s, context->client_formats[i].nChannels);
Packit 1fb8d4
		Stream_Read_UINT32(s, context->client_formats[i].nSamplesPerSec);
Packit 1fb8d4
		Stream_Read_UINT32(s, context->client_formats[i].nAvgBytesPerSec);
Packit 1fb8d4
		Stream_Read_UINT16(s, context->client_formats[i].nBlockAlign);
Packit 1fb8d4
		Stream_Read_UINT16(s, context->client_formats[i].wBitsPerSample);
Packit 1fb8d4
		Stream_Read_UINT16(s, context->client_formats[i].cbSize);
Packit 1fb8d4
Packit 1fb8d4
		if (context->client_formats[i].cbSize > 0)
Packit 1fb8d4
		{
Packit 1fb8d4
			if (!Stream_SafeSeek(s, context->client_formats[i].cbSize))
Packit 1fb8d4
			{
Packit 1fb8d4
				WLog_ERR(TAG, "Stream_SafeSeek failed!");
Packit 1fb8d4
				error = ERROR_INTERNAL_ERROR;
Packit 1fb8d4
				goto out_free;
Packit 1fb8d4
			}
Packit 1fb8d4
		}
Packit 1fb8d4
Packit 1fb8d4
		if (context->client_formats[i].wFormatTag != 0)
Packit 1fb8d4
		{
Packit Service 5a9772
			// lets call this a known format
Packit Service 5a9772
			// TODO: actually look through our own list of known formats
Packit 1fb8d4
			num_known_format++;
Packit 1fb8d4
		}
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	if (!context->num_client_formats)
Packit 1fb8d4
	{
Packit Service 5a9772
		WLog_ERR(TAG, "client doesn't support any known format!");
Packit 1fb8d4
		goto out_free;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	return CHANNEL_RC_OK;
Packit 1fb8d4
out_free:
Packit 1fb8d4
	free(context->client_formats);
Packit 1fb8d4
	return error;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
static DWORD WINAPI rdpsnd_server_thread(LPVOID arg)
Packit 1fb8d4
{
Packit 1fb8d4
	DWORD nCount, status;
Packit 1fb8d4
	HANDLE events[8];
Packit 1fb8d4
	RdpsndServerContext* context;
Packit 1fb8d4
	UINT error = CHANNEL_RC_OK;
Packit 1fb8d4
	context = (RdpsndServerContext*)arg;
Packit 1fb8d4
	nCount = 0;
Packit 1fb8d4
	events[nCount++] = context->priv->channelEvent;
Packit 1fb8d4
	events[nCount++] = context->priv->StopEvent;
Packit 1fb8d4
Packit 1fb8d4
	while (TRUE)
Packit 1fb8d4
	{
Packit 1fb8d4
		status = WaitForMultipleObjects(nCount, events, FALSE, INFINITE);
Packit 1fb8d4
Packit 1fb8d4
		if (status == WAIT_FAILED)
Packit 1fb8d4
		{
Packit 1fb8d4
			error = GetLastError();
Packit Service 5a9772
			WLog_ERR(TAG, "WaitForMultipleObjects failed with error %" PRIu32 "!", error);
Packit 1fb8d4
			break;
Packit 1fb8d4
		}
Packit 1fb8d4
Packit 1fb8d4
		status = WaitForSingleObject(context->priv->StopEvent, 0);
Packit 1fb8d4
Packit 1fb8d4
		if (status == WAIT_FAILED)
Packit 1fb8d4
		{
Packit 1fb8d4
			error = GetLastError();
Packit Service 5a9772
			WLog_ERR(TAG, "WaitForSingleObject failed with error %" PRIu32 "!", error);
Packit 1fb8d4
			break;
Packit 1fb8d4
		}
Packit 1fb8d4
Packit 1fb8d4
		if (status == WAIT_OBJECT_0)
Packit 1fb8d4
			break;
Packit 1fb8d4
Packit 1fb8d4
		if ((error = rdpsnd_server_handle_messages(context)))
Packit 1fb8d4
		{
Packit Service 5a9772
			WLog_ERR(TAG, "rdpsnd_server_handle_messages failed with error %" PRIu32 "", error);
Packit 1fb8d4
			break;
Packit 1fb8d4
		}
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	if (error && context->rdpcontext)
Packit Service 5a9772
		setChannelError(context->rdpcontext, error, "rdpsnd_server_thread reported an error");
Packit 1fb8d4
Packit 1fb8d4
	ExitThread(error);
Packit 1fb8d4
	return error;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
/**
Packit 1fb8d4
 * Function description
Packit 1fb8d4
 *
Packit 1fb8d4
 * @return 0 on success, otherwise a Win32 error code
Packit 1fb8d4
 */
Packit Service 5a9772
static UINT rdpsnd_server_initialize(RdpsndServerContext* context, BOOL ownThread)
Packit 1fb8d4
{
Packit 1fb8d4
	context->priv->ownThread = ownThread;
Packit 1fb8d4
	return context->Start(context);
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
/**
Packit 1fb8d4
 * Function description
Packit 1fb8d4
 *
Packit 1fb8d4
 * @return 0 on success, otherwise a Win32 error code
Packit 1fb8d4
 */
Packit Service 5a9772
static UINT rdpsnd_server_select_format(RdpsndServerContext* context, UINT16 client_format_index)
Packit 1fb8d4
{
Packit 1fb8d4
	int bs;
Packit 1fb8d4
	int out_buffer_size;
Packit 1fb8d4
	AUDIO_FORMAT* format;
Packit 1fb8d4
	UINT error = CHANNEL_RC_OK;
Packit 1fb8d4
Packit Service 5a9772
	if ((client_format_index >= context->num_client_formats) || (!context->src_format))
Packit 1fb8d4
	{
Packit Service 5a9772
		WLog_ERR(TAG, "index %d is not correct.", client_format_index);
Packit 1fb8d4
		return ERROR_INVALID_DATA;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	EnterCriticalSection(&context->priv->lock);
Packit 1fb8d4
	context->priv->src_bytes_per_sample = context->src_format->wBitsPerSample / 8;
Packit Service 5a9772
	context->priv->src_bytes_per_frame =
Packit Service 5a9772
	    context->priv->src_bytes_per_sample * context->src_format->nChannels;
Packit 1fb8d4
	context->selected_client_format = client_format_index;
Packit 1fb8d4
	format = &context->client_formats[client_format_index];
Packit 1fb8d4
Packit 1fb8d4
	if (format->nSamplesPerSec == 0)
Packit 1fb8d4
	{
Packit Service 5a9772
		WLog_ERR(TAG, "invalid Client Sound Format!!");
Packit 1fb8d4
		error = ERROR_INVALID_DATA;
Packit 1fb8d4
		goto out;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	if (context->latency <= 0)
Packit 1fb8d4
		context->latency = 50;
Packit 1fb8d4
Packit Service 5a9772
	context->priv->out_frames = context->src_format->nSamplesPerSec * context->latency / 1000;
Packit 1fb8d4
Packit 1fb8d4
	if (context->priv->out_frames < 1)
Packit 1fb8d4
		context->priv->out_frames = 1;
Packit 1fb8d4
Packit 1fb8d4
	switch (format->wFormatTag)
Packit 1fb8d4
	{
Packit 1fb8d4
		case WAVE_FORMAT_DVI_ADPCM:
Packit 1fb8d4
			bs = (format->nBlockAlign - 4 * format->nChannels) * 4;
Packit 1fb8d4
			context->priv->out_frames -= context->priv->out_frames % bs;
Packit 1fb8d4
Packit 1fb8d4
			if (context->priv->out_frames < bs)
Packit 1fb8d4
				context->priv->out_frames = bs;
Packit 1fb8d4
Packit 1fb8d4
			break;
Packit 1fb8d4
Packit 1fb8d4
		case WAVE_FORMAT_ADPCM:
Packit 1fb8d4
			bs = (format->nBlockAlign - 7 * format->nChannels) * 2 / format->nChannels + 2;
Packit 1fb8d4
			context->priv->out_frames -= context->priv->out_frames % bs;
Packit 1fb8d4
Packit 1fb8d4
			if (context->priv->out_frames < bs)
Packit 1fb8d4
				context->priv->out_frames = bs;
Packit 1fb8d4
Packit 1fb8d4
			break;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	context->priv->out_pending_frames = 0;
Packit Service 5a9772
	out_buffer_size = context->priv->out_frames * context->priv->src_bytes_per_frame;
Packit 1fb8d4
Packit 1fb8d4
	if (context->priv->out_buffer_size < out_buffer_size)
Packit 1fb8d4
	{
Packit 1fb8d4
		BYTE* newBuffer;
Packit 1fb8d4
		newBuffer = (BYTE*)realloc(context->priv->out_buffer, out_buffer_size);
Packit 1fb8d4
Packit 1fb8d4
		if (!newBuffer)
Packit 1fb8d4
		{
Packit 1fb8d4
			WLog_ERR(TAG, "realloc failed!");
Packit 1fb8d4
			error = CHANNEL_RC_NO_MEMORY;
Packit 1fb8d4
			goto out;
Packit 1fb8d4
		}
Packit 1fb8d4
Packit 1fb8d4
		context->priv->out_buffer = newBuffer;
Packit 1fb8d4
		context->priv->out_buffer_size = out_buffer_size;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	freerdp_dsp_context_reset(context->priv->dsp_context, format);
Packit 1fb8d4
out:
Packit 1fb8d4
	LeaveCriticalSection(&context->priv->lock);
Packit 1fb8d4
	return error;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
static BOOL rdpsnd_server_align_wave_pdu(wStream* s, UINT32 alignment)
Packit 1fb8d4
{
Packit 1fb8d4
	size_t size;
Packit 1fb8d4
	Stream_SealLength(s);
Packit 1fb8d4
	size = Stream_Length(s);
Packit 1fb8d4
Packit 1fb8d4
	if ((size % alignment) != 0)
Packit 1fb8d4
	{
Packit 1fb8d4
		size_t offset = alignment - size % alignment;
Packit 1fb8d4
Packit 1fb8d4
		if (!Stream_EnsureRemainingCapacity(s, offset))
Packit 1fb8d4
			return FALSE;
Packit 1fb8d4
Packit 1fb8d4
		Stream_Zero(s, offset);
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	Stream_SealLength(s);
Packit 1fb8d4
	return TRUE;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
/**
Packit 1fb8d4
 * Function description
Packit 1fb8d4
 * context->priv->lock should be obtained before calling this function
Packit 1fb8d4
 *
Packit 1fb8d4
 * @return 0 on success, otherwise a Win32 error code
Packit 1fb8d4
 */
Packit Service 5a9772
static UINT rdpsnd_server_send_wave_pdu(RdpsndServerContext* context, UINT16 wTimestamp)
Packit 1fb8d4
{
Packit 1fb8d4
	size_t length;
Packit 1fb8d4
	size_t start, end = 0;
Packit 1fb8d4
	const BYTE* src;
Packit 1fb8d4
	AUDIO_FORMAT* format;
Packit 1fb8d4
	ULONG written;
Packit 1fb8d4
	wStream* s = context->priv->rdpsnd_pdu;
Packit 1fb8d4
	UINT error = CHANNEL_RC_OK;
Packit 1fb8d4
Packit 1fb8d4
	if (context->selected_client_format >= context->num_client_formats)
Packit 1fb8d4
		return ERROR_INTERNAL_ERROR;
Packit 1fb8d4
Packit 1fb8d4
	format = &context->client_formats[context->selected_client_format];
Packit 1fb8d4
	/* WaveInfo PDU */
Packit 1fb8d4
	Stream_SetPosition(s, 0);
Packit Service 5a9772
	Stream_Write_UINT8(s, SNDC_WAVE);                        /* msgType */
Packit Service 5a9772
	Stream_Write_UINT8(s, 0);                                /* bPad */
Packit Service 5a9772
	Stream_Write_UINT16(s, 0);                               /* BodySize */
Packit Service 5a9772
	Stream_Write_UINT16(s, wTimestamp);                      /* wTimeStamp */
Packit 1fb8d4
	Stream_Write_UINT16(s, context->selected_client_format); /* wFormatNo */
Packit Service 5a9772
	Stream_Write_UINT8(s, context->block_no);                /* cBlockNo */
Packit Service 5a9772
	Stream_Seek(s, 3);                                       /* bPad */
Packit 1fb8d4
	start = Stream_GetPosition(s);
Packit 1fb8d4
	src = context->priv->out_buffer;
Packit 1fb8d4
	length = context->priv->out_pending_frames * context->priv->src_bytes_per_frame;
Packit 1fb8d4
Packit 1fb8d4
	if (!freerdp_dsp_encode(context->priv->dsp_context, context->src_format, src, length, s))
Packit 1fb8d4
		return ERROR_INTERNAL_ERROR;
Packit 1fb8d4
	else
Packit 1fb8d4
	{
Packit 1fb8d4
		/* Set stream size */
Packit 1fb8d4
		if (!rdpsnd_server_align_wave_pdu(s, format->nBlockAlign))
Packit 1fb8d4
			return ERROR_INTERNAL_ERROR;
Packit 1fb8d4
Packit 1fb8d4
		end = Stream_GetPosition(s);
Packit 1fb8d4
		Stream_SetPosition(s, 2);
Packit 1fb8d4
		Stream_Write_UINT16(s, end - start + 8);
Packit 1fb8d4
		Stream_SetPosition(s, end);
Packit 1fb8d4
		context->block_no = (context->block_no + 1) % 256;
Packit 1fb8d4
Packit Service 5a9772
		if (!WTSVirtualChannelWrite(context->priv->ChannelHandle, (PCHAR)Stream_Buffer(s),
Packit Service 5a9772
		                            start + 4, &written))
Packit 1fb8d4
		{
Packit 1fb8d4
			WLog_ERR(TAG, "WTSVirtualChannelWrite failed!");
Packit 1fb8d4
			error = ERROR_INTERNAL_ERROR;
Packit 1fb8d4
		}
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	if (error != CHANNEL_RC_OK)
Packit 1fb8d4
	{
Packit 1fb8d4
		WLog_ERR(TAG, "WTSVirtualChannelWrite failed!");
Packit 1fb8d4
		error = ERROR_INTERNAL_ERROR;
Packit 1fb8d4
		goto out;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	Stream_SetPosition(s, start);
Packit 1fb8d4
	Stream_Write_UINT32(s, 0); /* bPad */
Packit 1fb8d4
	Stream_SetPosition(s, start);
Packit 1fb8d4
Packit Service 5a9772
	if (!WTSVirtualChannelWrite(context->priv->ChannelHandle, (PCHAR)Stream_Pointer(s), end - start,
Packit Service 5a9772
	                            &written))
Packit 1fb8d4
	{
Packit 1fb8d4
		WLog_ERR(TAG, "WTSVirtualChannelWrite failed!");
Packit 1fb8d4
		error = ERROR_INTERNAL_ERROR;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
out:
Packit 1fb8d4
	Stream_SetPosition(s, 0);
Packit 1fb8d4
	context->priv->out_pending_frames = 0;
Packit 1fb8d4
	return error;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
/**
Packit 1fb8d4
 * Function description
Packit 1fb8d4
 * context->priv->lock should be obtained before calling this function
Packit 1fb8d4
 *
Packit 1fb8d4
 * @return 0 on success, otherwise a Win32 error code
Packit 1fb8d4
 */
Packit Service 5a9772
static UINT rdpsnd_server_send_wave2_pdu(RdpsndServerContext* context, UINT16 wTimestamp)
Packit 1fb8d4
{
Packit 1fb8d4
	size_t length;
Packit 1fb8d4
	size_t end = 0;
Packit 1fb8d4
	const BYTE* src;
Packit 1fb8d4
	AUDIO_FORMAT* format;
Packit 1fb8d4
	ULONG written;
Packit 1fb8d4
	wStream* s = context->priv->rdpsnd_pdu;
Packit 1fb8d4
	UINT error = CHANNEL_RC_OK;
Packit 1fb8d4
Packit 1fb8d4
	if (context->selected_client_format >= context->num_client_formats)
Packit 1fb8d4
		return ERROR_INTERNAL_ERROR;
Packit 1fb8d4
Packit 1fb8d4
	format = &context->client_formats[context->selected_client_format];
Packit 1fb8d4
	/* WaveInfo PDU */
Packit 1fb8d4
	Stream_SetPosition(s, 0);
Packit Service 5a9772
	Stream_Write_UINT8(s, SNDC_WAVE2);                       /* msgType */
Packit Service 5a9772
	Stream_Write_UINT8(s, 0);                                /* bPad */
Packit Service 5a9772
	Stream_Write_UINT16(s, 0);                               /* BodySize */
Packit Service 5a9772
	Stream_Write_UINT16(s, wTimestamp);                      /* wTimeStamp */
Packit 1fb8d4
	Stream_Write_UINT16(s, context->selected_client_format); /* wFormatNo */
Packit Service 5a9772
	Stream_Write_UINT8(s, context->block_no);                /* cBlockNo */
Packit Service 5a9772
	Stream_Seek(s, 3);                                       /* bPad */
Packit Service 5a9772
	Stream_Write_UINT32(s, wTimestamp);                      /* dwAudioTimeStamp */
Packit 1fb8d4
	src = context->priv->out_buffer;
Packit 1fb8d4
	length = context->priv->out_pending_frames * context->priv->src_bytes_per_frame;
Packit 1fb8d4
Packit 1fb8d4
	if (!freerdp_dsp_encode(context->priv->dsp_context, context->src_format, src, length, s))
Packit 1fb8d4
		error = ERROR_INTERNAL_ERROR;
Packit 1fb8d4
	else
Packit 1fb8d4
	{
Packit 1fb8d4
		BOOL rc;
Packit 1fb8d4
Packit 1fb8d4
		/* Set stream size */
Packit 1fb8d4
		if (!rdpsnd_server_align_wave_pdu(s, format->nBlockAlign))
Packit 1fb8d4
			return ERROR_INTERNAL_ERROR;
Packit 1fb8d4
Packit 1fb8d4
		end = Stream_GetPosition(s);
Packit 1fb8d4
		Stream_SetPosition(s, 2);
Packit 1fb8d4
		Stream_Write_UINT16(s, end - 4);
Packit 1fb8d4
		context->block_no = (context->block_no + 1) % 256;
Packit Service 5a9772
		rc = WTSVirtualChannelWrite(context->priv->ChannelHandle, (PCHAR)Stream_Buffer(s), end,
Packit Service 5a9772
		                            &written);
Packit 1fb8d4
Packit 1fb8d4
		if (!rc || (end != written))
Packit 1fb8d4
		{
Packit Service 5a9772
			WLog_ERR(TAG,
Packit Service 5a9772
			         "WTSVirtualChannelWrite failed! [stream length=%" PRIdz " - written=%" PRIu32,
Packit Service 5a9772
			         end, written);
Packit 1fb8d4
			error = ERROR_INTERNAL_ERROR;
Packit 1fb8d4
		}
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	Stream_SetPosition(s, 0);
Packit 1fb8d4
	context->priv->out_pending_frames = 0;
Packit 1fb8d4
	return error;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
/* Wrapper function to send WAVE or WAVE2 PDU depending on client connected */
Packit Service 5a9772
static UINT rdpsnd_server_send_audio_pdu(RdpsndServerContext* context, UINT16 wTimestamp)
Packit 1fb8d4
{
Packit 1fb8d4
	if (context->clientVersion >= CHANNEL_VERSION_WIN_8)
Packit 1fb8d4
		return rdpsnd_server_send_wave2_pdu(context, wTimestamp);
Packit 1fb8d4
	else
Packit 1fb8d4
		return rdpsnd_server_send_wave_pdu(context, wTimestamp);
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
/**
Packit 1fb8d4
 * Function description
Packit 1fb8d4
 *
Packit 1fb8d4
 * @return 0 on success, otherwise a Win32 error code
Packit 1fb8d4
 */
Packit Service 5a9772
static UINT rdpsnd_server_send_samples(RdpsndServerContext* context, const void* buf, int nframes,
Packit Service 5a9772
                                       UINT16 wTimestamp)
Packit 1fb8d4
{
Packit 1fb8d4
	int cframes;
Packit 1fb8d4
	int cframesize;
Packit 1fb8d4
	UINT error = CHANNEL_RC_OK;
Packit 1fb8d4
	EnterCriticalSection(&context->priv->lock);
Packit 1fb8d4
Packit 1fb8d4
	if (context->selected_client_format >= context->num_client_formats)
Packit 1fb8d4
	{
Packit 1fb8d4
		/* It's possible while format negotiation has not been done */
Packit 1fb8d4
		WLog_WARN(TAG, "Drop samples because client format has not been negotiated.");
Packit 1fb8d4
		error = ERROR_NOT_READY;
Packit 1fb8d4
		goto out;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	while (nframes > 0)
Packit 1fb8d4
	{
Packit Service 5a9772
		cframes = MIN(nframes, context->priv->out_frames - context->priv->out_pending_frames);
Packit 1fb8d4
		cframesize = cframes * context->priv->src_bytes_per_frame;
Packit 1fb8d4
		CopyMemory(context->priv->out_buffer +
Packit Service 5a9772
		               (context->priv->out_pending_frames * context->priv->src_bytes_per_frame),
Packit Service 5a9772
		           buf, cframesize);
Packit Service 5a9772
		buf = (BYTE*)buf + cframesize;
Packit 1fb8d4
		nframes -= cframes;
Packit 1fb8d4
		context->priv->out_pending_frames += cframes;
Packit 1fb8d4
Packit 1fb8d4
		if (context->priv->out_pending_frames >= context->priv->out_frames)
Packit 1fb8d4
		{
Packit 1fb8d4
			if ((error = rdpsnd_server_send_audio_pdu(context, wTimestamp)))
Packit 1fb8d4
			{
Packit Service 5a9772
				WLog_ERR(TAG, "rdpsnd_server_send_audio_pdu failed with error %" PRIu32 "", error);
Packit 1fb8d4
				break;
Packit 1fb8d4
			}
Packit 1fb8d4
		}
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
out:
Packit 1fb8d4
	LeaveCriticalSection(&context->priv->lock);
Packit 1fb8d4
	return error;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
/**
Packit 1fb8d4
 * Function description
Packit 1fb8d4
 *
Packit 1fb8d4
 * @return 0 on success, otherwise a Win32 error code
Packit 1fb8d4
 */
Packit Service 5a9772
static UINT rdpsnd_server_set_volume(RdpsndServerContext* context, int left, int right)
Packit 1fb8d4
{
Packit 1fb8d4
	size_t pos;
Packit 1fb8d4
	BOOL status;
Packit 1fb8d4
	ULONG written;
Packit 1fb8d4
	wStream* s = context->priv->rdpsnd_pdu;
Packit 1fb8d4
	Stream_Write_UINT8(s, SNDC_SETVOLUME);
Packit 1fb8d4
	Stream_Write_UINT8(s, 0);
Packit 1fb8d4
	Stream_Seek_UINT16(s);
Packit 1fb8d4
	Stream_Write_UINT16(s, left);
Packit 1fb8d4
	Stream_Write_UINT16(s, right);
Packit 1fb8d4
	pos = Stream_GetPosition(s);
Packit 1fb8d4
	Stream_SetPosition(s, 2);
Packit 1fb8d4
	Stream_Write_UINT16(s, pos - 4);
Packit 1fb8d4
	Stream_SetPosition(s, pos);
Packit Service 5a9772
	status = WTSVirtualChannelWrite(context->priv->ChannelHandle, (PCHAR)Stream_Buffer(s),
Packit Service 5a9772
	                                Stream_GetPosition(s), &written);
Packit 1fb8d4
	Stream_SetPosition(s, 0);
Packit 1fb8d4
	return status ? CHANNEL_RC_OK : ERROR_INTERNAL_ERROR;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
/**
Packit 1fb8d4
 * Function description
Packit 1fb8d4
 *
Packit 1fb8d4
 * @return 0 on success, otherwise a Win32 error code
Packit 1fb8d4
 */
Packit 1fb8d4
static UINT rdpsnd_server_close(RdpsndServerContext* context)
Packit 1fb8d4
{
Packit 1fb8d4
	size_t pos;
Packit 1fb8d4
	BOOL status;
Packit 1fb8d4
	ULONG written;
Packit 1fb8d4
	wStream* s = context->priv->rdpsnd_pdu;
Packit 1fb8d4
	UINT error = CHANNEL_RC_OK;
Packit 1fb8d4
	EnterCriticalSection(&context->priv->lock);
Packit 1fb8d4
Packit 1fb8d4
	if (context->priv->out_pending_frames > 0)
Packit 1fb8d4
	{
Packit 1fb8d4
		if (context->selected_client_format >= context->num_client_formats)
Packit 1fb8d4
		{
Packit 1fb8d4
			WLog_ERR(TAG, "Pending audio frame exists while no format selected.");
Packit 1fb8d4
			error = ERROR_INVALID_DATA;
Packit 1fb8d4
		}
Packit 1fb8d4
		else if ((error = rdpsnd_server_send_audio_pdu(context, 0)))
Packit 1fb8d4
		{
Packit Service 5a9772
			WLog_ERR(TAG, "rdpsnd_server_send_audio_pdu failed with error %" PRIu32 "", error);
Packit 1fb8d4
		}
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	LeaveCriticalSection(&context->priv->lock);
Packit 1fb8d4
Packit 1fb8d4
	if (error)
Packit 1fb8d4
		return error;
Packit 1fb8d4
Packit 1fb8d4
	context->selected_client_format = 0xFFFF;
Packit 1fb8d4
	Stream_Write_UINT8(s, SNDC_CLOSE);
Packit 1fb8d4
	Stream_Write_UINT8(s, 0);
Packit 1fb8d4
	Stream_Seek_UINT16(s);
Packit 1fb8d4
	pos = Stream_GetPosition(s);
Packit 1fb8d4
	Stream_SetPosition(s, 2);
Packit 1fb8d4
	Stream_Write_UINT16(s, pos - 4);
Packit 1fb8d4
	Stream_SetPosition(s, pos);
Packit Service 5a9772
	status = WTSVirtualChannelWrite(context->priv->ChannelHandle, (PCHAR)Stream_Buffer(s),
Packit Service 5a9772
	                                Stream_GetPosition(s), &written);
Packit 1fb8d4
	Stream_SetPosition(s, 0);
Packit 1fb8d4
	return status ? CHANNEL_RC_OK : ERROR_INTERNAL_ERROR;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
/**
Packit 1fb8d4
 * Function description
Packit 1fb8d4
 *
Packit 1fb8d4
 * @return 0 on success, otherwise a Win32 error code
Packit 1fb8d4
 */
Packit 1fb8d4
static UINT rdpsnd_server_start(RdpsndServerContext* context)
Packit 1fb8d4
{
Packit 1fb8d4
	void* buffer = NULL;
Packit 1fb8d4
	DWORD bytesReturned;
Packit 1fb8d4
	RdpsndServerPrivate* priv = context->priv;
Packit 1fb8d4
	UINT error = ERROR_INTERNAL_ERROR;
Packit Service 5a9772
	priv->ChannelHandle = WTSVirtualChannelOpen(context->vcm, WTS_CURRENT_SESSION, "rdpsnd");
Packit 1fb8d4
Packit 1fb8d4
	if (!priv->ChannelHandle)
Packit 1fb8d4
	{
Packit 1fb8d4
		WLog_ERR(TAG, "WTSVirtualChannelOpen failed!");
Packit 1fb8d4
		return ERROR_INTERNAL_ERROR;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	if (!WTSVirtualChannelQuery(priv->ChannelHandle, WTSVirtualEventHandle, &buffer,
Packit Service 5a9772
	                            &bytesReturned) ||
Packit Service 5a9772
	    (bytesReturned != sizeof(HANDLE)))
Packit 1fb8d4
	{
Packit 1fb8d4
		WLog_ERR(TAG,
Packit Service 5a9772
		         "error during WTSVirtualChannelQuery(WTSVirtualEventHandle) or invalid returned "
Packit Service 5a9772
		         "size(%" PRIu32 ")",
Packit 1fb8d4
		         bytesReturned);
Packit 1fb8d4
Packit 1fb8d4
		if (buffer)
Packit 1fb8d4
			WTSFreeMemory(buffer);
Packit 1fb8d4
Packit 1fb8d4
		goto out_close;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	CopyMemory(&priv->channelEvent, buffer, sizeof(HANDLE));
Packit 1fb8d4
	WTSFreeMemory(buffer);
Packit 1fb8d4
	priv->rdpsnd_pdu = Stream_New(NULL, 4096);
Packit 1fb8d4
Packit 1fb8d4
	if (!priv->rdpsnd_pdu)
Packit 1fb8d4
	{
Packit 1fb8d4
		WLog_ERR(TAG, "Stream_New failed!");
Packit 1fb8d4
		error = CHANNEL_RC_NO_MEMORY;
Packit 1fb8d4
		goto out_close;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	if (!InitializeCriticalSectionEx(&context->priv->lock, 0, 0))
Packit 1fb8d4
	{
Packit 1fb8d4
		WLog_ERR(TAG, "InitializeCriticalSectionEx failed!");
Packit 1fb8d4
		goto out_pdu;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	if ((error = rdpsnd_server_send_formats(context, context->priv->rdpsnd_pdu)))
Packit 1fb8d4
	{
Packit Service 5a9772
		WLog_ERR(TAG, "rdpsnd_server_send_formats failed with error %" PRIu32 "", error);
Packit 1fb8d4
		goto out_lock;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	if (priv->ownThread)
Packit 1fb8d4
	{
Packit 1fb8d4
		context->priv->StopEvent = CreateEvent(NULL, TRUE, FALSE, NULL);
Packit 1fb8d4
Packit 1fb8d4
		if (!context->priv->StopEvent)
Packit 1fb8d4
		{
Packit 1fb8d4
			WLog_ERR(TAG, "CreateEvent failed!");
Packit 1fb8d4
			goto out_lock;
Packit 1fb8d4
		}
Packit 1fb8d4
Packit Service 5a9772
		context->priv->Thread =
Packit Service 5a9772
		    CreateThread(NULL, 0, rdpsnd_server_thread, (void*)context, 0, NULL);
Packit 1fb8d4
Packit 1fb8d4
		if (!context->priv->Thread)
Packit 1fb8d4
		{
Packit 1fb8d4
			WLog_ERR(TAG, "CreateThread failed!");
Packit 1fb8d4
			goto out_stopEvent;
Packit 1fb8d4
		}
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	return CHANNEL_RC_OK;
Packit 1fb8d4
out_stopEvent:
Packit 1fb8d4
	CloseHandle(context->priv->StopEvent);
Packit 1fb8d4
	context->priv->StopEvent = NULL;
Packit 1fb8d4
out_lock:
Packit 1fb8d4
	DeleteCriticalSection(&context->priv->lock);
Packit 1fb8d4
out_pdu:
Packit 1fb8d4
	Stream_Free(context->priv->rdpsnd_pdu, TRUE);
Packit 1fb8d4
	context->priv->rdpsnd_pdu = NULL;
Packit 1fb8d4
out_close:
Packit 1fb8d4
	WTSVirtualChannelClose(context->priv->ChannelHandle);
Packit 1fb8d4
	context->priv->ChannelHandle = NULL;
Packit 1fb8d4
	return error;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
/**
Packit 1fb8d4
 * Function description
Packit 1fb8d4
 *
Packit 1fb8d4
 * @return 0 on success, otherwise a Win32 error code
Packit 1fb8d4
 */
Packit 1fb8d4
static UINT rdpsnd_server_stop(RdpsndServerContext* context)
Packit 1fb8d4
{
Packit 1fb8d4
	UINT error = CHANNEL_RC_OK;
Packit 1fb8d4
Packit 1fb8d4
	if (context->priv->ownThread)
Packit 1fb8d4
	{
Packit 1fb8d4
		if (context->priv->StopEvent)
Packit 1fb8d4
		{
Packit 1fb8d4
			SetEvent(context->priv->StopEvent);
Packit 1fb8d4
Packit 1fb8d4
			if (WaitForSingleObject(context->priv->Thread, INFINITE) == WAIT_FAILED)
Packit 1fb8d4
			{
Packit 1fb8d4
				error = GetLastError();
Packit Service 5a9772
				WLog_ERR(TAG, "WaitForSingleObject failed with error %" PRIu32 "!", error);
Packit 1fb8d4
				return error;
Packit 1fb8d4
			}
Packit 1fb8d4
Packit 1fb8d4
			CloseHandle(context->priv->Thread);
Packit 1fb8d4
			CloseHandle(context->priv->StopEvent);
Packit 1fb8d4
		}
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	DeleteCriticalSection(&context->priv->lock);
Packit 1fb8d4
Packit 1fb8d4
	if (context->priv->rdpsnd_pdu)
Packit 1fb8d4
		Stream_Free(context->priv->rdpsnd_pdu, TRUE);
Packit 1fb8d4
Packit 1fb8d4
	return error;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
RdpsndServerContext* rdpsnd_server_context_new(HANDLE vcm)
Packit 1fb8d4
{
Packit 1fb8d4
	RdpsndServerContext* context;
Packit 1fb8d4
	RdpsndServerPrivate* priv;
Packit 1fb8d4
	context = (RdpsndServerContext*)calloc(1, sizeof(RdpsndServerContext));
Packit 1fb8d4
Packit 1fb8d4
	if (!context)
Packit 1fb8d4
	{
Packit 1fb8d4
		WLog_ERR(TAG, "calloc failed!");
Packit 1fb8d4
		return NULL;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	context->vcm = vcm;
Packit 1fb8d4
	context->Start = rdpsnd_server_start;
Packit 1fb8d4
	context->Stop = rdpsnd_server_stop;
Packit 1fb8d4
	context->selected_client_format = 0xFFFF;
Packit 1fb8d4
	context->Initialize = rdpsnd_server_initialize;
Packit 1fb8d4
	context->SelectFormat = rdpsnd_server_select_format;
Packit 1fb8d4
	context->SendSamples = rdpsnd_server_send_samples;
Packit 1fb8d4
	context->SetVolume = rdpsnd_server_set_volume;
Packit 1fb8d4
	context->Close = rdpsnd_server_close;
Packit Service 5a9772
	context->priv = priv = (RdpsndServerPrivate*)calloc(1, sizeof(RdpsndServerPrivate));
Packit 1fb8d4
Packit 1fb8d4
	if (!priv)
Packit 1fb8d4
	{
Packit 1fb8d4
		WLog_ERR(TAG, "calloc failed!");
Packit 1fb8d4
		goto out_free;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	priv->dsp_context = freerdp_dsp_context_new(TRUE);
Packit 1fb8d4
Packit 1fb8d4
	if (!priv->dsp_context)
Packit 1fb8d4
	{
Packit 1fb8d4
		WLog_ERR(TAG, "freerdp_dsp_context_new failed!");
Packit 1fb8d4
		goto out_free_priv;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	priv->input_stream = Stream_New(NULL, 4);
Packit 1fb8d4
Packit 1fb8d4
	if (!priv->input_stream)
Packit 1fb8d4
	{
Packit 1fb8d4
		WLog_ERR(TAG, "Stream_New failed!");
Packit 1fb8d4
		goto out_free_dsp;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	priv->expectedBytes = 4;
Packit 1fb8d4
	priv->waitingHeader = TRUE;
Packit 1fb8d4
	priv->ownThread = TRUE;
Packit 1fb8d4
	return context;
Packit 1fb8d4
out_free_dsp:
Packit 1fb8d4
	freerdp_dsp_context_free(priv->dsp_context);
Packit 1fb8d4
out_free_priv:
Packit 1fb8d4
	free(context->priv);
Packit 1fb8d4
out_free:
Packit 1fb8d4
	free(context);
Packit 1fb8d4
	return NULL;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
void rdpsnd_server_context_reset(RdpsndServerContext* context)
Packit 1fb8d4
{
Packit 1fb8d4
	context->priv->expectedBytes = 4;
Packit 1fb8d4
	context->priv->waitingHeader = TRUE;
Packit 1fb8d4
	Stream_SetPosition(context->priv->input_stream, 0);
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
void rdpsnd_server_context_free(RdpsndServerContext* context)
Packit 1fb8d4
{
Packit 1fb8d4
	if (context->priv->ChannelHandle)
Packit 1fb8d4
		WTSVirtualChannelClose(context->priv->ChannelHandle);
Packit 1fb8d4
Packit 1fb8d4
	free(context->priv->out_buffer);
Packit 1fb8d4
Packit 1fb8d4
	if (context->priv->dsp_context)
Packit 1fb8d4
		freerdp_dsp_context_free(context->priv->dsp_context);
Packit 1fb8d4
Packit 1fb8d4
	if (context->priv->input_stream)
Packit 1fb8d4
		Stream_Free(context->priv->input_stream, TRUE);
Packit 1fb8d4
Packit Service 5a9772
	free(context->server_formats);
Packit 1fb8d4
	free(context->client_formats);
Packit 1fb8d4
	free(context->priv);
Packit 1fb8d4
	free(context);
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
HANDLE rdpsnd_server_get_event_handle(RdpsndServerContext* context)
Packit 1fb8d4
{
Packit 1fb8d4
	return context->priv->channelEvent;
Packit 1fb8d4
}
Packit 1fb8d4
Packit 1fb8d4
/*
Packit 1fb8d4
 * Handle rpdsnd messages - server side
Packit 1fb8d4
 *
Packit 1fb8d4
 * @param Server side context
Packit 1fb8d4
 *
Packit 1fb8d4
 * @return 0 on success
Packit 1fb8d4
 * 		   ERROR_NO_DATA if no data could be read this time
Packit 1fb8d4
 *         otherwise error
Packit 1fb8d4
 */
Packit 1fb8d4
/**
Packit 1fb8d4
 * Function description
Packit 1fb8d4
 *
Packit 1fb8d4
 * @return 0 on success, otherwise a Win32 error code
Packit 1fb8d4
 */
Packit 1fb8d4
UINT rdpsnd_server_handle_messages(RdpsndServerContext* context)
Packit 1fb8d4
{
Packit 1fb8d4
	DWORD bytesReturned;
Packit 1fb8d4
	UINT ret = CHANNEL_RC_OK;
Packit 1fb8d4
	RdpsndServerPrivate* priv = context->priv;
Packit 1fb8d4
	wStream* s = priv->input_stream;
Packit 1fb8d4
Packit 1fb8d4
	if (!WTSVirtualChannelRead(priv->ChannelHandle, 0, (PCHAR)Stream_Pointer(s),
Packit 1fb8d4
	                           priv->expectedBytes, &bytesReturned))
Packit 1fb8d4
	{
Packit 1fb8d4
		if (GetLastError() == ERROR_NO_DATA)
Packit 1fb8d4
			return ERROR_NO_DATA;
Packit 1fb8d4
Packit Service 5a9772
		WLog_ERR(TAG, "channel connection closed");
Packit 1fb8d4
		return ERROR_INTERNAL_ERROR;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	priv->expectedBytes -= bytesReturned;
Packit 1fb8d4
	Stream_Seek(s, bytesReturned);
Packit 1fb8d4
Packit 1fb8d4
	if (priv->expectedBytes)
Packit 1fb8d4
		return CHANNEL_RC_OK;
Packit 1fb8d4
Packit 1fb8d4
	Stream_SealLength(s);
Packit 1fb8d4
	Stream_SetPosition(s, 0);
Packit 1fb8d4
Packit 1fb8d4
	if (priv->waitingHeader)
Packit 1fb8d4
	{
Packit 1fb8d4
		/* header case */
Packit 1fb8d4
		Stream_Read_UINT8(s, priv->msgType);
Packit 1fb8d4
		Stream_Seek_UINT8(s); /* bPad */
Packit 1fb8d4
		Stream_Read_UINT16(s, priv->expectedBytes);
Packit 1fb8d4
		priv->waitingHeader = FALSE;
Packit 1fb8d4
		Stream_SetPosition(s, 0);
Packit 1fb8d4
Packit 1fb8d4
		if (priv->expectedBytes)
Packit 1fb8d4
		{
Packit 1fb8d4
			if (!Stream_EnsureCapacity(s, priv->expectedBytes))
Packit 1fb8d4
			{
Packit 1fb8d4
				WLog_ERR(TAG, "Stream_EnsureCapacity failed!");
Packit 1fb8d4
				return CHANNEL_RC_NO_MEMORY;
Packit 1fb8d4
			}
Packit 1fb8d4
Packit 1fb8d4
			return CHANNEL_RC_OK;
Packit 1fb8d4
		}
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	/* when here we have the header + the body */
Packit 1fb8d4
#ifdef WITH_DEBUG_SND
Packit Service 5a9772
	WLog_DBG(TAG, "message type %" PRIu8 "", priv->msgType);
Packit 1fb8d4
#endif
Packit 1fb8d4
	priv->expectedBytes = 4;
Packit 1fb8d4
	priv->waitingHeader = TRUE;
Packit 1fb8d4
Packit 1fb8d4
	switch (priv->msgType)
Packit 1fb8d4
	{
Packit 1fb8d4
		case SNDC_WAVECONFIRM:
Packit 1fb8d4
			ret = rdpsnd_server_recv_waveconfirm(context, s);
Packit 1fb8d4
			break;
Packit 1fb8d4
Packit 1fb8d4
		case SNDC_FORMATS:
Packit 1fb8d4
			ret = rdpsnd_server_recv_formats(context, s);
Packit 1fb8d4
Packit 1fb8d4
			if ((ret == CHANNEL_RC_OK) && (context->clientVersion < CHANNEL_VERSION_WIN_7))
Packit 1fb8d4
				IFCALL(context->Activated, context);
Packit 1fb8d4
Packit 1fb8d4
			break;
Packit 1fb8d4
Packit 1fb8d4
		case SNDC_QUALITYMODE:
Packit 1fb8d4
			ret = rdpsnd_server_recv_quality_mode(context, s);
Packit 1fb8d4
			Stream_SetPosition(s,
Packit 1fb8d4
			                   0); /* in case the Activated callback tries to treat some messages */
Packit 1fb8d4
Packit 1fb8d4
			if ((ret == CHANNEL_RC_OK) && (context->clientVersion >= CHANNEL_VERSION_WIN_7))
Packit 1fb8d4
				IFCALL(context->Activated, context);
Packit 1fb8d4
Packit 1fb8d4
			break;
Packit 1fb8d4
Packit 1fb8d4
		default:
Packit Service 5a9772
			WLog_ERR(TAG, "UNKNOWN MESSAGE TYPE!! (0x%02" PRIX8 ")", priv->msgType);
Packit 1fb8d4
			ret = ERROR_INVALID_DATA;
Packit 1fb8d4
			break;
Packit 1fb8d4
	}
Packit 1fb8d4
Packit 1fb8d4
	Stream_SetPosition(s, 0);
Packit 1fb8d4
	return ret;
Packit 1fb8d4
}