/** * vim: set ts=4 : * ============================================================================= * SourceMod Sample Extension * Copyright (C) 2004-2008 AlliedModders LLC. All rights reserved. * ============================================================================= * * This program is free software; you can redistribute it and/or modify it under * the terms of the GNU General Public License, version 3.0, as published by the * Free Software Foundation. * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS * FOR A PARTICULAR PURPOSE. See the GNU General Public License for more * details. * * You should have received a copy of the GNU General Public License along with * this program. If not, see . * * As a special exception, AlliedModders LLC gives you permission to link the * code of this program (as well as its derivative works) to "Half-Life 2," the * "Source Engine," the "SourcePawn JIT," and any Game MODs that run on software * by the Valve Corporation. You must obey the GNU General Public License in * all respects for all other code used. Additionally, AlliedModders LLC grants * this exception to all derivative works. AlliedModders LLC defines further * exceptions, found in LICENSE.txt (as of this writing, version JULY-31-2007), * or . * * Version: $Id$ */ //#define _GNU_SOURCE #include #include #include #include #include #include #include #include #include #include #include #include #include "extension.h" #define LISTEN_ADDR "127.0.0.1" //#define LISTEN_ADDR "10.0.0.101" #define LISTEN_PORT 27020 /** * @file extension.cpp * @brief Implement extension code here. */ template inline T min(T a, T b) { return a> 8); } return ~crc; } CVoice g_Interface; SMEXT_LINK(&g_Interface); ISDKTools *g_pSDKTools = NULL; SH_DECL_MANUALHOOK0(GetPlayerSlot, 0, 0, 0, int); // IClient::GetPlayerSlot double getTime() { struct timespec tv; if(clock_gettime(CLOCK_REALTIME, &tv) != 0) return 0; return (tv.tv_sec + (tv.tv_nsec / 1000000000.0)); } void OnGameFrame(bool simulating) { g_Interface.OnGameFrame(simulating); } CVoice::CVoice() { m_ListenSocket = -1; m_PollFds = 0; for(int i = 1; i < 1 + MAX_CLIENTS; i++) m_aPollFds[i].fd = -1; for(int i = 0; i < MAX_CLIENTS; i++) m_aClients[i].m_Socket = -1; m_AvailableTime = 0.0; m_Silk_EncoderState = NULL; m_SV_BroadcastVoiceData = NULL; } bool CVoice::SDK_OnLoad(char *error, size_t maxlength, bool late) { // Setup engine-specific data. Dl_info info; void *engineFactory = (void *)g_SMAPI->GetEngineFactory(false); if(dladdr(engineFactory, &info) == 0) { g_SMAPI->Format(error, maxlength, "dladdr(engineFactory) failed."); return false; } void *pEngineSo = dlopen(info.dli_fname, RTLD_NOW); if(pEngineSo == NULL) { g_SMAPI->Format(error, maxlength, "dlopen(%s) failed.", info.dli_fname); return false; } int engineVersion = g_SMAPI->GetSourceEngineBuild(); int offsPlayerSlot = 0; switch (engineVersion) { case SOURCE_ENGINE_CSGO: #ifdef _WIN32 m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->FindPattern(pEngineSo, "\x55\x8B\xEC\x81\xEC\xD0\x00\x00\x00\x53\x56\x57", 12); offsPlayerSlot = 15; #else m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->ResolveSymbol(pEngineSo, "_Z21SV_BroadcastVoiceDataP7IClientiPcx"); offsPlayerSlot = 16; #endif break; case SOURCE_ENGINE_LEFT4DEAD2: #ifdef _WIN32 m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->FindPattern(pEngineSo, "\x55\x8B\xEC\x83\xEC\x70\xA1\x2A\x2A\x2A\x2A\x33\xC5\x89\x45\xFC\xA1\x2A\x2A\x2A\x2A\x53\x56", 23); offsPlayerSlot = 14; #else m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->ResolveSymbol(pEngineSo, "_Z21SV_BroadcastVoiceDataP7IClientiPcx"); offsPlayerSlot = 15; #endif break; case SOURCE_ENGINE_NUCLEARDAWN: #ifdef _WIN32 m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->FindPattern(pEngineSo, "\x55\x8B\xEC\xA1\x2A\x2A\x2A\x2A\x83\xEC\x58\x57\x33\xFF", 14); offsPlayerSlot = 14; #else m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->ResolveSymbol(pEngineSo, "_Z21SV_BroadcastVoiceDataP7IClientiPcx"); offsPlayerSlot = 15; #endif break; case SOURCE_ENGINE_INSURGENCY: #ifdef _WIN32 m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->FindPattern(pEngineSo, "\x55\x8B\xEC\x83\xEC\x74\x68\x2A\x2A\x2A\x2A\x8D\x4D\xE4\xE8", 15); offsPlayerSlot = 14; #else m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->ResolveSymbol(pEngineSo, "_Z21SV_BroadcastVoiceDataP7IClientiPcx"); offsPlayerSlot = 15; #endif break; case SOURCE_ENGINE_TF2: case SOURCE_ENGINE_CSS: case SOURCE_ENGINE_HL2DM: case SOURCE_ENGINE_DODS: case SOURCE_ENGINE_SDK2013: #ifdef _WIN32 m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->FindPattern(pEngineSo, "\x55\x8B\xEC\xA1\x2A\x2A\x2A\x2A\x83\xEC\x50\x83\x78\x30", 14); offsPlayerSlot = 14; #else m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->ResolveSymbol(pEngineSo, "_Z21SV_BroadcastVoiceDataP7IClientiPcx"); offsPlayerSlot = 15; #endif break; default: g_SMAPI->Format(error, maxlength, "Unsupported game."); dlclose(pEngineSo); return false; } dlclose(pEngineSo); if(!m_SV_BroadcastVoiceData) { g_SMAPI->Format(error, maxlength, "SV_BroadcastVoiceData sigscan failed."); return false; } SH_MANUALHOOK_RECONFIGURE(GetPlayerSlot, offsPlayerSlot, 0, 0); // Init tcp server m_ListenSocket = socket(AF_INET, SOCK_STREAM, 0); if(m_ListenSocket < 0) { g_SMAPI->Format(error, maxlength, "Failed creating socket."); SDK_OnUnload(); return false; } int yes = 1; if(setsockopt(m_ListenSocket, SOL_SOCKET, SO_REUSEADDR, &yes, sizeof(int)) < 0) { g_SMAPI->Format(error, maxlength, "Failed setting SO_REUSEADDR on socket."); SDK_OnUnload(); return false; } sockaddr_in bindAddr; memset(&bindAddr, 0, sizeof(bindAddr)); bindAddr.sin_family = AF_INET; inet_aton(LISTEN_ADDR, &bindAddr.sin_addr); bindAddr.sin_port = htons(LISTEN_PORT); // Listen on LISTEN_ADDR:LISTEN_PORT if(bind(m_ListenSocket, (sockaddr *)&bindAddr, sizeof(sockaddr_in)) < 0) { g_SMAPI->Format(error, maxlength, "Failed binding to socket (%d '%s').", errno, strerror(errno)); SDK_OnUnload(); return false; } if(listen(m_ListenSocket, MAX_CLIENTS) < 0) { g_SMAPI->Format(error, maxlength, "Failed listening on socket."); SDK_OnUnload(); return false; } m_aPollFds[0].fd = m_ListenSocket; m_aPollFds[0].events = POLLIN; m_PollFds++; // Encoder settings m_EncoderSettings.InputSampleRate_kHz = 48; // 8, 12, 16, 24, 32, 44.1, 48 m_EncoderSettings.OutputSampleRate_kHz = 16; // 8, 12, 16, 24 m_EncoderSettings.TargetBitRate_Kbps = 100; // 6 - 40 m_EncoderSettings.PacketSize_ms = 20; // 20, 40, 60, 80, 100 m_EncoderSettings.FrameSize_ms = 20; // m_EncoderSettings.PacketLoss_perc = 0; // 0 - 100 m_EncoderSettings.Complexity = 2; // 0 - 2 m_EncoderSettings.InBandFEC = 0; // 0, 1 m_EncoderSettings.DTX = 0; // 0, 1 // Init SILK encoder int encoderSize; SKP_Silk_SDK_Get_Encoder_Size(&encoderSize); m_Silk_EncoderState = malloc(encoderSize); if(!m_Silk_EncoderState) { g_SMAPI->Format(error, maxlength, "Failed to malloc %d bytes for silk encoder.", encoderSize); SDK_OnUnload(); return false; } int retEnc = SKP_Silk_SDK_InitEncoder(m_Silk_EncoderState, &m_Silk_EncoderControl); if(retEnc != SKP_SILK_NO_ERROR) { g_SMAPI->Format(error, maxlength, "Silk encoder initialization failed with: %d", retEnc); SDK_OnUnload(); return false; } m_Silk_EncoderControl.API_sampleRate = m_EncoderSettings.InputSampleRate_kHz * 1000; m_Silk_EncoderControl.maxInternalSampleRate = m_EncoderSettings.OutputSampleRate_kHz * 1000; m_Silk_EncoderControl.bitRate = m_EncoderSettings.TargetBitRate_Kbps * 1000; m_Silk_EncoderControl.packetSize = m_EncoderSettings.PacketSize_ms * m_EncoderSettings.InputSampleRate_kHz; m_Silk_EncoderControl.packetLossPercentage = m_EncoderSettings.PacketLoss_perc; m_Silk_EncoderControl.complexity = m_EncoderSettings.Complexity; m_Silk_EncoderControl.useInBandFEC = m_EncoderSettings.InBandFEC; m_Silk_EncoderControl.useDTX = m_EncoderSettings.DTX; smutils->AddGameFrameHook(::OnGameFrame); return true; } void CVoice::SDK_OnAllLoaded() { SM_GET_LATE_IFACE(SDKTOOLS, g_pSDKTools); if(g_pSDKTools == NULL) smutils->LogError(myself, "SDKTools interface not found"); } void CVoice::SDK_OnUnload() { smutils->RemoveGameFrameHook(::OnGameFrame); if(m_ListenSocket != -1) { close(m_ListenSocket); m_ListenSocket = -1; } for(int Client = 0; Client < MAX_CLIENTS; Client++) { if(m_aClients[Client].m_Socket != -1) { close(m_aClients[Client].m_Socket); m_aClients[Client].m_Socket = -1; } } if(m_Silk_EncoderState) { free(m_Silk_EncoderState); m_Silk_EncoderState = NULL; } } void CVoice::OnGameFrame(bool simulating) { HandleNetwork(); HandleVoiceData(); } void CVoice::HandleNetwork() { if(m_ListenSocket == -1) return; int PollRes = poll(m_aPollFds, m_PollFds, 0); if(PollRes <= 0) return; // Accept new clients if(m_aPollFds[0].revents & POLLIN) { // Find slot int Client; for(Client = 0; Client < MAX_CLIENTS; Client++) { if(m_aClients[Client].m_Socket == -1) break; } // no free slot if(Client != MAX_CLIENTS) { sockaddr_in addr; size_t size = sizeof(sockaddr_in); int Socket = accept(m_ListenSocket, (sockaddr *)&addr, &size); m_aClients[Client].m_Socket = Socket; m_aClients[Client].m_BufferWriteIndex = 0; m_aClients[Client].m_LastLength = 0; m_aClients[Client].m_LastValidData = 0.0; m_aClients[Client].m_New = true; m_aPollFds[m_PollFds].fd = Socket; m_aPollFds[m_PollFds].events = POLLIN | POLLHUP; m_aPollFds[m_PollFds].revents = 0; m_PollFds++; smutils->LogMessage(myself, "Client %d connected!\n", Client); } } bool CompressPollFds = false; for(int PollFds = 1; PollFds < m_PollFds; PollFds++) { int Client = -1; for(Client = 0; Client < MAX_CLIENTS; Client++) { if(m_aClients[Client].m_Socket == m_aPollFds[PollFds].fd) break; } if(Client == -1) continue; CClient *pClient = &m_aClients[Client]; // Connection shutdown prematurely ^C // Make sure to set SO_LINGER l_onoff = 1, l_linger = 0 if(m_aPollFds[PollFds].revents & POLLHUP) { close(pClient->m_Socket); pClient->m_Socket = -1; m_aPollFds[PollFds].fd = -1; CompressPollFds = true; smutils->LogMessage(myself, "Client %d disconnected!(2)\n", Client); continue; } // Data available? if(!(m_aPollFds[PollFds].revents & POLLIN)) continue; size_t BytesAvailable; if(ioctl(pClient->m_Socket, FIONREAD, &BytesAvailable) == -1) continue; if(pClient->m_New) { pClient->m_BufferWriteIndex = m_Buffer.GetReadIndex(); pClient->m_New = false; } m_Buffer.SetWriteIndex(pClient->m_BufferWriteIndex); // Don't recv() when we can't fit data into the ringbuffer unsigned char aBuf[32768]; if(min(BytesAvailable, sizeof(aBuf)) > m_Buffer.CurrentFree() * sizeof(int16_t)) continue; ssize_t Bytes = recv(pClient->m_Socket, aBuf, sizeof(aBuf), 0); if(Bytes <= 0) { close(pClient->m_Socket); pClient->m_Socket = -1; m_aPollFds[PollFds].fd = -1; CompressPollFds = true; smutils->LogMessage(myself, "Client %d disconnected!(1)\n", Client); continue; } // Got data! OnDataReceived(pClient, (int16_t *)aBuf, Bytes / sizeof(int16_t)); pClient->m_LastLength = m_Buffer.CurrentLength(); pClient->m_BufferWriteIndex = m_Buffer.GetWriteIndex(); } if(CompressPollFds) { for(int PollFds = 1; PollFds < m_PollFds; PollFds++) { if(m_aPollFds[PollFds].fd != -1) continue; for(int PollFds_ = PollFds; PollFds_ < 1 + MAX_CLIENTS; PollFds_++) m_aPollFds[PollFds_].fd = m_aPollFds[PollFds_ + 1].fd; PollFds--; m_PollFds--; } } } void CVoice::OnDataReceived(CClient *pClient, int16_t *pData, size_t Samples) { // Check for empty input ssize_t DataStartsAt = -1; for(size_t i = 0; i < Samples; i++) { if(pData[i] == 0) continue; DataStartsAt = i; break; } // Discard empty data if last vaild data was more than a second ago. if(pClient->m_LastValidData + 1.0 < getTime()) { // All empty if(DataStartsAt == -1) return; // Data starts here pData += DataStartsAt; Samples -= DataStartsAt; } if(!m_Buffer.Push(pData, Samples)) { smutils->LogError(myself, "Buffer push failed!!! Samples: %u, Free: %u\n", Samples, m_Buffer.CurrentFree()); return; } pClient->m_LastValidData = getTime(); } struct SteamVoiceHeader { uint32_t iSteamAccountID : 32; uint32_t iSteamCommunity : 32; uint32_t nPayload1 : 8; uint32_t iSampleRate : 16; uint32_t nPayload2 : 8; uint32_t iDataLength : 16; }; void CVoice::HandleVoiceData() { int SamplesPerFrame = m_EncoderSettings.FrameSize_ms * m_EncoderSettings.InputSampleRate_kHz; int FramesAvailable = m_Buffer.TotalLength() / SamplesPerFrame; float TimeAvailable = (float)m_Buffer.TotalLength() / (m_EncoderSettings.InputSampleRate_kHz * 1000.0); if(!FramesAvailable) return; // Before starting playback we want at least 100ms in the buffer if(m_AvailableTime < getTime() && TimeAvailable < 0.1) return; // let the clients have no more than 500ms if(m_AvailableTime > getTime() + 0.5) return; // 5 = max frames per packet FramesAvailable = min(FramesAvailable, 5); // 0 = SourceTV IClient *pClient = g_pSDKTools->GetIServer()->GetClient(0); if(!pClient) return; SteamVoiceHeader Header; size_t HeaderSize = 14; Header.iSteamAccountID = 1; // Steam Account ID Header.iSteamCommunity = 0x01100001; // Steam Community ID part: 0x01100001 << 32 Header.nPayload1 = 11; // nPayLoad | Type 11 = Samplerate Header.iSampleRate = m_EncoderSettings.OutputSampleRate_kHz * 1000; // Samplerate Header.nPayload2 = 4; // nPayLoad | Type 4 = Silk Frames Header.iDataLength = 0; // Silk Frames total length // Header + Frames + CRC32 unsigned char aFinal[HeaderSize + 8192 + sizeof(uint32_t)]; size_t FinalSize = HeaderSize; for(int Frame = 0; Frame < FramesAvailable; Frame++) { // Get data into buffer from ringbuffer. int16_t aBuffer[SamplesPerFrame]; size_t OldReadIdx = m_Buffer.m_ReadIndex; size_t OldCurLength = m_Buffer.CurrentLength(); size_t OldTotalLength = m_Buffer.TotalLength(); if(!m_Buffer.Pop(aBuffer, SamplesPerFrame)) { smutils->LogError(myself, "Buffer pop failed!!! Samples: %u, Length: %u\n", SamplesPerFrame, m_Buffer.TotalLength()); return; } // Frame Size int16_t *pFrameSize = (int16_t *)(&aFinal[FinalSize]); FinalSize += sizeof(int16_t); Header.iDataLength += sizeof(int16_t); *pFrameSize = sizeof(aFinal) - HeaderSize - sizeof(uint32_t) - FinalSize; // Encode it! int Ret = SKP_Silk_SDK_Encode(m_Silk_EncoderState, &m_Silk_EncoderControl, aBuffer, SamplesPerFrame, &aFinal[FinalSize], pFrameSize); if(Ret) { smutils->LogError(myself, "SKP_Silk_SDK_Encode returned %d\n", Ret); return; } FinalSize += *pFrameSize; Header.iDataLength += *pFrameSize; // Check for buffer underruns for(int Client = 0; Client < MAX_CLIENTS; Client++) { CClient *pClient = &m_aClients[Client]; if(pClient->m_Socket == -1 || pClient->m_New == true) continue; m_Buffer.SetWriteIndex(pClient->m_BufferWriteIndex); if(m_Buffer.CurrentLength() > pClient->m_LastLength) { pClient->m_BufferWriteIndex = m_Buffer.GetReadIndex(); m_Buffer.SetWriteIndex(pClient->m_BufferWriteIndex); pClient->m_LastLength = m_Buffer.CurrentLength(); } } } // Header memcpy(aFinal, &Header, HeaderSize); // CRC32 *(uint32_t *)(&aFinal[FinalSize]) = UTIL_CRC32(aFinal, FinalSize); FinalSize += sizeof(uint32_t); SV_BroadcastVoiceData(pClient, FinalSize, aFinal); if(m_AvailableTime < getTime()) m_AvailableTime = getTime(); m_AvailableTime += (double)FramesAvailable * ((double)m_EncoderSettings.FrameSize_ms / 1000.0); } void CVoice::SV_BroadcastVoiceData(IClient *pClient, int nBytes, unsigned char *pData) { m_SV_BroadcastVoiceData(pClient, nBytes, pData, 0); }