extension.cpp 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655
  1. /**
  2. * vim: set ts=4 :
  3. * =============================================================================
  4. * SourceMod Sample Extension
  5. * Copyright (C) 2004-2008 AlliedModders LLC. All rights reserved.
  6. * =============================================================================
  7. *
  8. * This program is free software; you can redistribute it and/or modify it under
  9. * the terms of the GNU General Public License, version 3.0, as published by the
  10. * Free Software Foundation.
  11. *
  12. * This program is distributed in the hope that it will be useful, but WITHOUT
  13. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
  14. * FOR A PARTICULAR PURPOSE. See the GNU General Public License for more
  15. * details.
  16. *
  17. * You should have received a copy of the GNU General Public License along with
  18. * this program. If not, see <http://www.gnu.org/licenses/>.
  19. *
  20. * As a special exception, AlliedModders LLC gives you permission to link the
  21. * code of this program (as well as its derivative works) to "Half-Life 2," the
  22. * "Source Engine," the "SourcePawn JIT," and any Game MODs that run on software
  23. * by the Valve Corporation. You must obey the GNU General Public License in
  24. * all respects for all other code used. Additionally, AlliedModders LLC grants
  25. * this exception to all derivative works. AlliedModders LLC defines further
  26. * exceptions, found in LICENSE.txt (as of this writing, version JULY-31-2007),
  27. * or <http://www.sourcemod.net/license.php>.
  28. *
  29. * Version: $Id$
  30. */
  31. //#define _GNU_SOURCE
  32. #include <stdlib.h>
  33. #include <string.h>
  34. #include <sys/types.h>
  35. #include <sys/socket.h>
  36. #include <sys/ioctl.h>
  37. #include <netinet/in.h>
  38. #include <arpa/inet.h>
  39. #include <fcntl.h>
  40. #include <poll.h>
  41. #include <iclient.h>
  42. #include <iserver.h>
  43. #include <ISDKTools.h>
  44. #include "extension.h"
  45. #define LISTEN_ADDR "127.0.0.1"
  46. //#define LISTEN_ADDR "10.0.0.101"
  47. #define LISTEN_PORT 27020
  48. /**
  49. * @file extension.cpp
  50. * @brief Implement extension code here.
  51. */
  52. template <typename T> inline T min(T a, T b) { return a<b?a:b; }
  53. /**
  54. * Polynomial: 0x04C11DB7
  55. */
  56. const unsigned int CRCTable[256] = {
  57. 0x00000000, 0x77073096, 0xee0e612c, 0x990951ba, 0x076dc419, 0x706af48f,
  58. 0xe963a535, 0x9e6495a3, 0x0edb8832, 0x79dcb8a4, 0xe0d5e91e, 0x97d2d988,
  59. 0x09b64c2b, 0x7eb17cbd, 0xe7b82d07, 0x90bf1d91, 0x1db71064, 0x6ab020f2,
  60. 0xf3b97148, 0x84be41de, 0x1adad47d, 0x6ddde4eb, 0xf4d4b551, 0x83d385c7,
  61. 0x136c9856, 0x646ba8c0, 0xfd62f97a, 0x8a65c9ec, 0x14015c4f, 0x63066cd9,
  62. 0xfa0f3d63, 0x8d080df5, 0x3b6e20c8, 0x4c69105e, 0xd56041e4, 0xa2677172,
  63. 0x3c03e4d1, 0x4b04d447, 0xd20d85fd, 0xa50ab56b, 0x35b5a8fa, 0x42b2986c,
  64. 0xdbbbc9d6, 0xacbcf940, 0x32d86ce3, 0x45df5c75, 0xdcd60dcf, 0xabd13d59,
  65. 0x26d930ac, 0x51de003a, 0xc8d75180, 0xbfd06116, 0x21b4f4b5, 0x56b3c423,
  66. 0xcfba9599, 0xb8bda50f, 0x2802b89e, 0x5f058808, 0xc60cd9b2, 0xb10be924,
  67. 0x2f6f7c87, 0x58684c11, 0xc1611dab, 0xb6662d3d, 0x76dc4190, 0x01db7106,
  68. 0x98d220bc, 0xefd5102a, 0x71b18589, 0x06b6b51f, 0x9fbfe4a5, 0xe8b8d433,
  69. 0x7807c9a2, 0x0f00f934, 0x9609a88e, 0xe10e9818, 0x7f6a0dbb, 0x086d3d2d,
  70. 0x91646c97, 0xe6635c01, 0x6b6b51f4, 0x1c6c6162, 0x856530d8, 0xf262004e,
  71. 0x6c0695ed, 0x1b01a57b, 0x8208f4c1, 0xf50fc457, 0x65b0d9c6, 0x12b7e950,
  72. 0x8bbeb8ea, 0xfcb9887c, 0x62dd1ddf, 0x15da2d49, 0x8cd37cf3, 0xfbd44c65,
  73. 0x4db26158, 0x3ab551ce, 0xa3bc0074, 0xd4bb30e2, 0x4adfa541, 0x3dd895d7,
  74. 0xa4d1c46d, 0xd3d6f4fb, 0x4369e96a, 0x346ed9fc, 0xad678846, 0xda60b8d0,
  75. 0x44042d73, 0x33031de5, 0xaa0a4c5f, 0xdd0d7cc9, 0x5005713c, 0x270241aa,
  76. 0xbe0b1010, 0xc90c2086, 0x5768b525, 0x206f85b3, 0xb966d409, 0xce61e49f,
  77. 0x5edef90e, 0x29d9c998, 0xb0d09822, 0xc7d7a8b4, 0x59b33d17, 0x2eb40d81,
  78. 0xb7bd5c3b, 0xc0ba6cad, 0xedb88320, 0x9abfb3b6, 0x03b6e20c, 0x74b1d29a,
  79. 0xead54739, 0x9dd277af, 0x04db2615, 0x73dc1683, 0xe3630b12, 0x94643b84,
  80. 0x0d6d6a3e, 0x7a6a5aa8, 0xe40ecf0b, 0x9309ff9d, 0x0a00ae27, 0x7d079eb1,
  81. 0xf00f9344, 0x8708a3d2, 0x1e01f268, 0x6906c2fe, 0xf762575d, 0x806567cb,
  82. 0x196c3671, 0x6e6b06e7, 0xfed41b76, 0x89d32be0, 0x10da7a5a, 0x67dd4acc,
  83. 0xf9b9df6f, 0x8ebeeff9, 0x17b7be43, 0x60b08ed5, 0xd6d6a3e8, 0xa1d1937e,
  84. 0x38d8c2c4, 0x4fdff252, 0xd1bb67f1, 0xa6bc5767, 0x3fb506dd, 0x48b2364b,
  85. 0xd80d2bda, 0xaf0a1b4c, 0x36034af6, 0x41047a60, 0xdf60efc3, 0xa867df55,
  86. 0x316e8eef, 0x4669be79, 0xcb61b38c, 0xbc66831a, 0x256fd2a0, 0x5268e236,
  87. 0xcc0c7795, 0xbb0b4703, 0x220216b9, 0x5505262f, 0xc5ba3bbe, 0xb2bd0b28,
  88. 0x2bb45a92, 0x5cb36a04, 0xc2d7ffa7, 0xb5d0cf31, 0x2cd99e8b, 0x5bdeae1d,
  89. 0x9b64c2b0, 0xec63f226, 0x756aa39c, 0x026d930a, 0x9c0906a9, 0xeb0e363f,
  90. 0x72076785, 0x05005713, 0x95bf4a82, 0xe2b87a14, 0x7bb12bae, 0x0cb61b38,
  91. 0x92d28e9b, 0xe5d5be0d, 0x7cdcefb7, 0x0bdbdf21, 0x86d3d2d4, 0xf1d4e242,
  92. 0x68ddb3f8, 0x1fda836e, 0x81be16cd, 0xf6b9265b, 0x6fb077e1, 0x18b74777,
  93. 0x88085ae6, 0xff0f6a70, 0x66063bca, 0x11010b5c, 0x8f659eff, 0xf862ae69,
  94. 0x616bffd3, 0x166ccf45, 0xa00ae278, 0xd70dd2ee, 0x4e048354, 0x3903b3c2,
  95. 0xa7672661, 0xd06016f7, 0x4969474d, 0x3e6e77db, 0xaed16a4a, 0xd9d65adc,
  96. 0x40df0b66, 0x37d83bf0, 0xa9bcae53, 0xdebb9ec5, 0x47b2cf7f, 0x30b5ffe9,
  97. 0xbdbdf21c, 0xcabac28a, 0x53b39330, 0x24b4a3a6, 0xbad03605, 0xcdd70693,
  98. 0x54de5729, 0x23d967bf, 0xb3667a2e, 0xc4614ab8, 0x5d681b02, 0x2a6f2b94,
  99. 0xb40bbe37, 0xc30c8ea1, 0x5a05df1b, 0x2d02ef8d};
  100. unsigned int UTIL_CRC32(const void *pdata, size_t data_length)
  101. {
  102. unsigned char *data = (unsigned char *)pdata;
  103. unsigned int crc = 0xFFFFFFFF;
  104. unsigned char c;
  105. for(size_t i = 0; i < data_length; i++, data++)
  106. {
  107. c = (unsigned char)((crc ^ *data) & 0xFF);
  108. crc = CRCTable[c] ^ (crc >> 8);
  109. }
  110. return ~crc;
  111. }
  112. CVoice g_Interface;
  113. SMEXT_LINK(&g_Interface);
  114. ISDKTools *g_pSDKTools = NULL;
  115. SH_DECL_MANUALHOOK0(GetPlayerSlot, 0, 0, 0, int); // IClient::GetPlayerSlot
  116. double getTime()
  117. {
  118. struct timespec tv;
  119. if(clock_gettime(CLOCK_REALTIME, &tv) != 0)
  120. return 0;
  121. return (tv.tv_sec + (tv.tv_nsec / 1000000000.0));
  122. }
  123. void OnGameFrame(bool simulating)
  124. {
  125. g_Interface.OnGameFrame(simulating);
  126. }
  127. CVoice::CVoice()
  128. {
  129. m_ListenSocket = -1;
  130. m_PollFds = 0;
  131. for(int i = 1; i < 1 + MAX_CLIENTS; i++)
  132. m_aPollFds[i].fd = -1;
  133. for(int i = 0; i < MAX_CLIENTS; i++)
  134. m_aClients[i].m_Socket = -1;
  135. m_AvailableTime = 0.0;
  136. m_Silk_EncoderState = NULL;
  137. m_SV_BroadcastVoiceData = NULL;
  138. }
  139. bool CVoice::SDK_OnLoad(char *error, size_t maxlength, bool late)
  140. {
  141. // Setup engine-specific data.
  142. Dl_info info;
  143. void *engineFactory = (void *)g_SMAPI->GetEngineFactory(false);
  144. if(dladdr(engineFactory, &info) == 0)
  145. {
  146. g_SMAPI->Format(error, maxlength, "dladdr(engineFactory) failed.");
  147. return false;
  148. }
  149. void *pEngineSo = dlopen(info.dli_fname, RTLD_NOW);
  150. if(pEngineSo == NULL)
  151. {
  152. g_SMAPI->Format(error, maxlength, "dlopen(%s) failed.", info.dli_fname);
  153. return false;
  154. }
  155. int engineVersion = g_SMAPI->GetSourceEngineBuild();
  156. int offsPlayerSlot = 0;
  157. switch (engineVersion)
  158. {
  159. case SOURCE_ENGINE_CSGO:
  160. #ifdef _WIN32
  161. m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->FindPattern(pEngineSo, "\x55\x8B\xEC\x81\xEC\xD0\x00\x00\x00\x53\x56\x57", 12);
  162. offsPlayerSlot = 15;
  163. #else
  164. m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->ResolveSymbol(pEngineSo, "_Z21SV_BroadcastVoiceDataP7IClientiPcx");
  165. offsPlayerSlot = 16;
  166. #endif
  167. break;
  168. case SOURCE_ENGINE_LEFT4DEAD2:
  169. #ifdef _WIN32
  170. 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);
  171. offsPlayerSlot = 14;
  172. #else
  173. m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->ResolveSymbol(pEngineSo, "_Z21SV_BroadcastVoiceDataP7IClientiPcx");
  174. offsPlayerSlot = 15;
  175. #endif
  176. break;
  177. case SOURCE_ENGINE_NUCLEARDAWN:
  178. #ifdef _WIN32
  179. m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->FindPattern(pEngineSo, "\x55\x8B\xEC\xA1\x2A\x2A\x2A\x2A\x83\xEC\x58\x57\x33\xFF", 14);
  180. offsPlayerSlot = 14;
  181. #else
  182. m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->ResolveSymbol(pEngineSo, "_Z21SV_BroadcastVoiceDataP7IClientiPcx");
  183. offsPlayerSlot = 15;
  184. #endif
  185. break;
  186. case SOURCE_ENGINE_INSURGENCY:
  187. #ifdef _WIN32
  188. 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);
  189. offsPlayerSlot = 14;
  190. #else
  191. m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->ResolveSymbol(pEngineSo, "_Z21SV_BroadcastVoiceDataP7IClientiPcx");
  192. offsPlayerSlot = 15;
  193. #endif
  194. break;
  195. case SOURCE_ENGINE_TF2:
  196. case SOURCE_ENGINE_CSS:
  197. case SOURCE_ENGINE_HL2DM:
  198. case SOURCE_ENGINE_DODS:
  199. case SOURCE_ENGINE_SDK2013:
  200. #ifdef _WIN32
  201. m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->FindPattern(pEngineSo, "\x55\x8B\xEC\xA1\x2A\x2A\x2A\x2A\x83\xEC\x50\x83\x78\x30", 14);
  202. offsPlayerSlot = 14;
  203. #else
  204. m_SV_BroadcastVoiceData = (t_SV_BroadcastVoiceData)memutils->ResolveSymbol(pEngineSo, "_Z21SV_BroadcastVoiceDataP7IClientiPcx");
  205. offsPlayerSlot = 15;
  206. #endif
  207. break;
  208. default:
  209. g_SMAPI->Format(error, maxlength, "Unsupported game.");
  210. dlclose(pEngineSo);
  211. return false;
  212. }
  213. dlclose(pEngineSo);
  214. if(!m_SV_BroadcastVoiceData)
  215. {
  216. g_SMAPI->Format(error, maxlength, "SV_BroadcastVoiceData sigscan failed.");
  217. return false;
  218. }
  219. SH_MANUALHOOK_RECONFIGURE(GetPlayerSlot, offsPlayerSlot, 0, 0);
  220. // Init tcp server
  221. m_ListenSocket = socket(AF_INET, SOCK_STREAM, 0);
  222. if(m_ListenSocket < 0)
  223. {
  224. g_SMAPI->Format(error, maxlength, "Failed creating socket.");
  225. SDK_OnUnload();
  226. return false;
  227. }
  228. int yes = 1;
  229. if(setsockopt(m_ListenSocket, SOL_SOCKET, SO_REUSEADDR, &yes, sizeof(int)) < 0)
  230. {
  231. g_SMAPI->Format(error, maxlength, "Failed setting SO_REUSEADDR on socket.");
  232. SDK_OnUnload();
  233. return false;
  234. }
  235. sockaddr_in bindAddr;
  236. memset(&bindAddr, 0, sizeof(bindAddr));
  237. bindAddr.sin_family = AF_INET;
  238. inet_aton(LISTEN_ADDR, &bindAddr.sin_addr);
  239. bindAddr.sin_port = htons(LISTEN_PORT);
  240. // Listen on LISTEN_ADDR:LISTEN_PORT
  241. if(bind(m_ListenSocket, (sockaddr *)&bindAddr, sizeof(sockaddr_in)) < 0)
  242. {
  243. g_SMAPI->Format(error, maxlength, "Failed binding to socket (%d '%s').", errno, strerror(errno));
  244. SDK_OnUnload();
  245. return false;
  246. }
  247. if(listen(m_ListenSocket, MAX_CLIENTS) < 0)
  248. {
  249. g_SMAPI->Format(error, maxlength, "Failed listening on socket.");
  250. SDK_OnUnload();
  251. return false;
  252. }
  253. m_aPollFds[0].fd = m_ListenSocket;
  254. m_aPollFds[0].events = POLLIN;
  255. m_PollFds++;
  256. // Encoder settings
  257. m_EncoderSettings.InputSampleRate_kHz = 48; // 8, 12, 16, 24, 32, 44.1, 48
  258. m_EncoderSettings.OutputSampleRate_kHz = 16; // 8, 12, 16, 24
  259. m_EncoderSettings.TargetBitRate_Kbps = 100; // 6 - 40
  260. m_EncoderSettings.PacketSize_ms = 20; // 20, 40, 60, 80, 100
  261. m_EncoderSettings.FrameSize_ms = 20; //
  262. m_EncoderSettings.PacketLoss_perc = 0; // 0 - 100
  263. m_EncoderSettings.Complexity = 2; // 0 - 2
  264. m_EncoderSettings.InBandFEC = 0; // 0, 1
  265. m_EncoderSettings.DTX = 0; // 0, 1
  266. // Init SILK encoder
  267. int encoderSize;
  268. SKP_Silk_SDK_Get_Encoder_Size(&encoderSize);
  269. m_Silk_EncoderState = malloc(encoderSize);
  270. if(!m_Silk_EncoderState)
  271. {
  272. g_SMAPI->Format(error, maxlength, "Failed to malloc %d bytes for silk encoder.", encoderSize);
  273. SDK_OnUnload();
  274. return false;
  275. }
  276. int retEnc = SKP_Silk_SDK_InitEncoder(m_Silk_EncoderState, &m_Silk_EncoderControl);
  277. if(retEnc != SKP_SILK_NO_ERROR)
  278. {
  279. g_SMAPI->Format(error, maxlength, "Silk encoder initialization failed with: %d", retEnc);
  280. SDK_OnUnload();
  281. return false;
  282. }
  283. m_Silk_EncoderControl.API_sampleRate = m_EncoderSettings.InputSampleRate_kHz * 1000;
  284. m_Silk_EncoderControl.maxInternalSampleRate = m_EncoderSettings.OutputSampleRate_kHz * 1000;
  285. m_Silk_EncoderControl.bitRate = m_EncoderSettings.TargetBitRate_Kbps * 1000;
  286. m_Silk_EncoderControl.packetSize = m_EncoderSettings.PacketSize_ms * m_EncoderSettings.InputSampleRate_kHz;
  287. m_Silk_EncoderControl.packetLossPercentage = m_EncoderSettings.PacketLoss_perc;
  288. m_Silk_EncoderControl.complexity = m_EncoderSettings.Complexity;
  289. m_Silk_EncoderControl.useInBandFEC = m_EncoderSettings.InBandFEC;
  290. m_Silk_EncoderControl.useDTX = m_EncoderSettings.DTX;
  291. smutils->AddGameFrameHook(::OnGameFrame);
  292. return true;
  293. }
  294. void CVoice::SDK_OnAllLoaded()
  295. {
  296. SM_GET_LATE_IFACE(SDKTOOLS, g_pSDKTools);
  297. if(g_pSDKTools == NULL)
  298. smutils->LogError(myself, "SDKTools interface not found");
  299. }
  300. void CVoice::SDK_OnUnload()
  301. {
  302. smutils->RemoveGameFrameHook(::OnGameFrame);
  303. if(m_ListenSocket != -1)
  304. {
  305. close(m_ListenSocket);
  306. m_ListenSocket = -1;
  307. }
  308. for(int Client = 0; Client < MAX_CLIENTS; Client++)
  309. {
  310. if(m_aClients[Client].m_Socket != -1)
  311. {
  312. close(m_aClients[Client].m_Socket);
  313. m_aClients[Client].m_Socket = -1;
  314. }
  315. }
  316. if(m_Silk_EncoderState)
  317. {
  318. free(m_Silk_EncoderState);
  319. m_Silk_EncoderState = NULL;
  320. }
  321. }
  322. void CVoice::OnGameFrame(bool simulating)
  323. {
  324. HandleNetwork();
  325. HandleVoiceData();
  326. }
  327. void CVoice::HandleNetwork()
  328. {
  329. if(m_ListenSocket == -1)
  330. return;
  331. int PollRes = poll(m_aPollFds, m_PollFds, 0);
  332. if(PollRes <= 0)
  333. return;
  334. // Accept new clients
  335. if(m_aPollFds[0].revents & POLLIN)
  336. {
  337. // Find slot
  338. int Client;
  339. for(Client = 0; Client < MAX_CLIENTS; Client++)
  340. {
  341. if(m_aClients[Client].m_Socket == -1)
  342. break;
  343. }
  344. // no free slot
  345. if(Client != MAX_CLIENTS)
  346. {
  347. sockaddr_in addr;
  348. size_t size = sizeof(sockaddr_in);
  349. int Socket = accept(m_ListenSocket, (sockaddr *)&addr, &size);
  350. m_aClients[Client].m_Socket = Socket;
  351. m_aClients[Client].m_BufferWriteIndex = 0;
  352. m_aClients[Client].m_LastLength = 0;
  353. m_aClients[Client].m_LastValidData = 0.0;
  354. m_aClients[Client].m_New = true;
  355. m_aPollFds[m_PollFds].fd = Socket;
  356. m_aPollFds[m_PollFds].events = POLLIN | POLLHUP;
  357. m_aPollFds[m_PollFds].revents = 0;
  358. m_PollFds++;
  359. smutils->LogMessage(myself, "Client %d connected!\n", Client);
  360. }
  361. }
  362. bool CompressPollFds = false;
  363. for(int PollFds = 1; PollFds < m_PollFds; PollFds++)
  364. {
  365. int Client = -1;
  366. for(Client = 0; Client < MAX_CLIENTS; Client++)
  367. {
  368. if(m_aClients[Client].m_Socket == m_aPollFds[PollFds].fd)
  369. break;
  370. }
  371. if(Client == -1)
  372. continue;
  373. CClient *pClient = &m_aClients[Client];
  374. // Connection shutdown prematurely ^C
  375. // Make sure to set SO_LINGER l_onoff = 1, l_linger = 0
  376. if(m_aPollFds[PollFds].revents & POLLHUP)
  377. {
  378. close(pClient->m_Socket);
  379. pClient->m_Socket = -1;
  380. m_aPollFds[PollFds].fd = -1;
  381. CompressPollFds = true;
  382. smutils->LogMessage(myself, "Client %d disconnected!(2)\n", Client);
  383. continue;
  384. }
  385. // Data available?
  386. if(!(m_aPollFds[PollFds].revents & POLLIN))
  387. continue;
  388. size_t BytesAvailable;
  389. if(ioctl(pClient->m_Socket, FIONREAD, &BytesAvailable) == -1)
  390. continue;
  391. if(pClient->m_New)
  392. {
  393. pClient->m_BufferWriteIndex = m_Buffer.GetReadIndex();
  394. pClient->m_New = false;
  395. }
  396. m_Buffer.SetWriteIndex(pClient->m_BufferWriteIndex);
  397. // Don't recv() when we can't fit data into the ringbuffer
  398. unsigned char aBuf[32768];
  399. if(min(BytesAvailable, sizeof(aBuf)) > m_Buffer.CurrentFree() * sizeof(int16_t))
  400. continue;
  401. ssize_t Bytes = recv(pClient->m_Socket, aBuf, sizeof(aBuf), 0);
  402. if(Bytes <= 0)
  403. {
  404. close(pClient->m_Socket);
  405. pClient->m_Socket = -1;
  406. m_aPollFds[PollFds].fd = -1;
  407. CompressPollFds = true;
  408. smutils->LogMessage(myself, "Client %d disconnected!(1)\n", Client);
  409. continue;
  410. }
  411. // Got data!
  412. OnDataReceived(pClient, (int16_t *)aBuf, Bytes / sizeof(int16_t));
  413. pClient->m_LastLength = m_Buffer.CurrentLength();
  414. pClient->m_BufferWriteIndex = m_Buffer.GetWriteIndex();
  415. }
  416. if(CompressPollFds)
  417. {
  418. for(int PollFds = 1; PollFds < m_PollFds; PollFds++)
  419. {
  420. if(m_aPollFds[PollFds].fd != -1)
  421. continue;
  422. for(int PollFds_ = PollFds; PollFds_ < 1 + MAX_CLIENTS; PollFds_++)
  423. m_aPollFds[PollFds_].fd = m_aPollFds[PollFds_ + 1].fd;
  424. PollFds--;
  425. m_PollFds--;
  426. }
  427. }
  428. }
  429. void CVoice::OnDataReceived(CClient *pClient, int16_t *pData, size_t Samples)
  430. {
  431. // Check for empty input
  432. ssize_t DataStartsAt = -1;
  433. for(size_t i = 0; i < Samples; i++)
  434. {
  435. if(pData[i] == 0)
  436. continue;
  437. DataStartsAt = i;
  438. break;
  439. }
  440. // Discard empty data if last vaild data was more than a second ago.
  441. if(pClient->m_LastValidData + 1.0 < getTime())
  442. {
  443. // All empty
  444. if(DataStartsAt == -1)
  445. return;
  446. // Data starts here
  447. pData += DataStartsAt;
  448. Samples -= DataStartsAt;
  449. }
  450. if(!m_Buffer.Push(pData, Samples))
  451. {
  452. smutils->LogError(myself, "Buffer push failed!!! Samples: %u, Free: %u\n", Samples, m_Buffer.CurrentFree());
  453. return;
  454. }
  455. pClient->m_LastValidData = getTime();
  456. }
  457. struct SteamVoiceHeader
  458. {
  459. uint32_t iSteamAccountID : 32;
  460. uint32_t iSteamCommunity : 32;
  461. uint32_t nPayload1 : 8;
  462. uint32_t iSampleRate : 16;
  463. uint32_t nPayload2 : 8;
  464. uint32_t iDataLength : 16;
  465. };
  466. void CVoice::HandleVoiceData()
  467. {
  468. int SamplesPerFrame = m_EncoderSettings.FrameSize_ms * m_EncoderSettings.InputSampleRate_kHz;
  469. int FramesAvailable = m_Buffer.TotalLength() / SamplesPerFrame;
  470. float TimeAvailable = (float)m_Buffer.TotalLength() / (m_EncoderSettings.InputSampleRate_kHz * 1000.0);
  471. if(!FramesAvailable)
  472. return;
  473. // Before starting playback we want at least 100ms in the buffer
  474. if(m_AvailableTime < getTime() && TimeAvailable < 0.1)
  475. return;
  476. // let the clients have no more than 500ms
  477. if(m_AvailableTime > getTime() + 0.5)
  478. return;
  479. // 5 = max frames per packet
  480. FramesAvailable = min(FramesAvailable, 5);
  481. // 0 = SourceTV
  482. IClient *pClient = g_pSDKTools->GetIServer()->GetClient(0);
  483. if(!pClient)
  484. return;
  485. SteamVoiceHeader Header;
  486. size_t HeaderSize = 14;
  487. Header.iSteamAccountID = 1; // Steam Account ID
  488. Header.iSteamCommunity = 0x01100001; // Steam Community ID part: 0x01100001 << 32
  489. Header.nPayload1 = 11; // nPayLoad | Type 11 = Samplerate
  490. Header.iSampleRate = m_EncoderSettings.OutputSampleRate_kHz * 1000; // Samplerate
  491. Header.nPayload2 = 4; // nPayLoad | Type 4 = Silk Frames
  492. Header.iDataLength = 0; // Silk Frames total length
  493. // Header + Frames + CRC32
  494. unsigned char aFinal[HeaderSize + 8192 + sizeof(uint32_t)];
  495. size_t FinalSize = HeaderSize;
  496. for(int Frame = 0; Frame < FramesAvailable; Frame++)
  497. {
  498. // Get data into buffer from ringbuffer.
  499. int16_t aBuffer[SamplesPerFrame];
  500. size_t OldReadIdx = m_Buffer.m_ReadIndex;
  501. size_t OldCurLength = m_Buffer.CurrentLength();
  502. size_t OldTotalLength = m_Buffer.TotalLength();
  503. if(!m_Buffer.Pop(aBuffer, SamplesPerFrame))
  504. {
  505. smutils->LogError(myself, "Buffer pop failed!!! Samples: %u, Length: %u\n", SamplesPerFrame, m_Buffer.TotalLength());
  506. return;
  507. }
  508. // Frame Size
  509. int16_t *pFrameSize = (int16_t *)(&aFinal[FinalSize]);
  510. FinalSize += sizeof(int16_t);
  511. Header.iDataLength += sizeof(int16_t);
  512. *pFrameSize = sizeof(aFinal) - HeaderSize - sizeof(uint32_t) - FinalSize;
  513. // Encode it!
  514. int Ret = SKP_Silk_SDK_Encode(m_Silk_EncoderState, &m_Silk_EncoderControl, aBuffer,
  515. SamplesPerFrame, &aFinal[FinalSize], pFrameSize);
  516. if(Ret)
  517. {
  518. smutils->LogError(myself, "SKP_Silk_SDK_Encode returned %d\n", Ret);
  519. return;
  520. }
  521. FinalSize += *pFrameSize;
  522. Header.iDataLength += *pFrameSize;
  523. // Check for buffer underruns
  524. for(int Client = 0; Client < MAX_CLIENTS; Client++)
  525. {
  526. CClient *pClient = &m_aClients[Client];
  527. if(pClient->m_Socket == -1 || pClient->m_New == true)
  528. continue;
  529. m_Buffer.SetWriteIndex(pClient->m_BufferWriteIndex);
  530. if(m_Buffer.CurrentLength() > pClient->m_LastLength)
  531. {
  532. pClient->m_BufferWriteIndex = m_Buffer.GetReadIndex();
  533. m_Buffer.SetWriteIndex(pClient->m_BufferWriteIndex);
  534. pClient->m_LastLength = m_Buffer.CurrentLength();
  535. }
  536. }
  537. }
  538. // Header
  539. memcpy(aFinal, &Header, HeaderSize);
  540. // CRC32
  541. *(uint32_t *)(&aFinal[FinalSize]) = UTIL_CRC32(aFinal, FinalSize);
  542. FinalSize += sizeof(uint32_t);
  543. SV_BroadcastVoiceData(pClient, FinalSize, aFinal);
  544. if(m_AvailableTime < getTime())
  545. m_AvailableTime = getTime();
  546. m_AvailableTime += (double)FramesAvailable * ((double)m_EncoderSettings.FrameSize_ms / 1000.0);
  547. }
  548. void CVoice::SV_BroadcastVoiceData(IClient *pClient, int nBytes, unsigned char *pData)
  549. {
  550. m_SV_BroadcastVoiceData(pClient, nBytes, pData, 0);
  551. }