123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991 |
- /*
- Minetest
- Copyright (C) 2013 celeron55, Perttu Ahola <celeron55@gmail.com>
- This program is free software; you can redistribute it and/or modify
- it under the terms of the GNU Lesser General Public License as published by
- the Free Software Foundation; either version 2.1 of the License, or
- (at your option) any later version.
- 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 Lesser General Public License for more details.
- You should have received a copy of the GNU Lesser General Public License along
- with this program; if not, write to the Free Software Foundation, Inc.,
- 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
- */
- #include <iomanip>
- #include <cerrno>
- #include "connection.h"
- #include "serialization.h"
- #include "log.h"
- #include "porting.h"
- #include "network/networkpacket.h"
- #include "network/peerhandler.h"
- #include "util/serialize.h"
- #include "util/numeric.h"
- #include "util/string.h"
- #include "settings.h"
- #include "profiler.h"
- namespace con
- {
- /******************************************************************************/
- /* defines used for debugging and profiling */
- /******************************************************************************/
- #ifdef NDEBUG
- #define LOG(a) a
- #define PROFILE(a)
- #undef DEBUG_CONNECTION_KBPS
- #else
- /* this mutex is used to achieve log message consistency */
- std::mutex log_message_mutex;
- #define LOG(a) \
- { \
- MutexAutoLock loglock(log_message_mutex); \
- a; \
- }
- #define PROFILE(a) a
- //#define DEBUG_CONNECTION_KBPS
- #undef DEBUG_CONNECTION_KBPS
- #endif
- static inline float CALC_DTIME(u64 lasttime, u64 curtime)
- {
- float value = ( curtime - lasttime) / 1000.0;
- return MYMAX(MYMIN(value,0.1),0.0);
- }
- #define MAX_UDP_PEERS 65535
- #define PING_TIMEOUT 5.0
- /* maximum number of retries for reliable packets */
- #define MAX_RELIABLE_RETRY 5
- static u16 readPeerId(u8 *packetdata)
- {
- return readU16(&packetdata[4]);
- }
- static u8 readChannel(u8 *packetdata)
- {
- return readU8(&packetdata[6]);
- }
- BufferedPacket makePacket(Address &address, u8 *data, u32 datasize,
- u32 protocol_id, u16 sender_peer_id, u8 channel)
- {
- u32 packet_size = datasize + BASE_HEADER_SIZE;
- BufferedPacket p(packet_size);
- p.address = address;
- writeU32(&p.data[0], protocol_id);
- writeU16(&p.data[4], sender_peer_id);
- writeU8(&p.data[6], channel);
- memcpy(&p.data[BASE_HEADER_SIZE], data, datasize);
- return p;
- }
- BufferedPacket makePacket(Address &address, SharedBuffer<u8> &data,
- u32 protocol_id, u16 sender_peer_id, u8 channel)
- {
- return makePacket(address, *data, data.getSize(),
- protocol_id, sender_peer_id, channel);
- }
- SharedBuffer<u8> makeOriginalPacket(
- SharedBuffer<u8> data)
- {
- u32 header_size = 1;
- u32 packet_size = data.getSize() + header_size;
- SharedBuffer<u8> b(packet_size);
- writeU8(&(b[0]), TYPE_ORIGINAL);
- if (data.getSize() > 0) {
- memcpy(&(b[header_size]), *data, data.getSize());
- }
- return b;
- }
- std::list<SharedBuffer<u8> > makeSplitPacket(
- SharedBuffer<u8> data,
- u32 chunksize_max,
- u16 seqnum)
- {
- // Chunk packets, containing the TYPE_SPLIT header
- std::list<SharedBuffer<u8> > chunks;
- u32 chunk_header_size = 7;
- u32 maximum_data_size = chunksize_max - chunk_header_size;
- u32 start = 0;
- u32 end = 0;
- u32 chunk_num = 0;
- u16 chunk_count = 0;
- do{
- end = start + maximum_data_size - 1;
- if (end > data.getSize() - 1)
- end = data.getSize() - 1;
- u32 payload_size = end - start + 1;
- u32 packet_size = chunk_header_size + payload_size;
- SharedBuffer<u8> chunk(packet_size);
- writeU8(&chunk[0], TYPE_SPLIT);
- writeU16(&chunk[1], seqnum);
- // [3] u16 chunk_count is written at next stage
- writeU16(&chunk[5], chunk_num);
- memcpy(&chunk[chunk_header_size], &data[start], payload_size);
- chunks.push_back(chunk);
- chunk_count++;
- start = end + 1;
- chunk_num++;
- }
- while(end != data.getSize() - 1);
- for (SharedBuffer<u8> &chunk : chunks) {
- // Write chunk_count
- writeU16(&(chunk[3]), chunk_count);
- }
- return chunks;
- }
- std::list<SharedBuffer<u8> > makeAutoSplitPacket(
- SharedBuffer<u8> data,
- u32 chunksize_max,
- u16 &split_seqnum)
- {
- u32 original_header_size = 1;
- std::list<SharedBuffer<u8> > list;
- if (data.getSize() + original_header_size > chunksize_max)
- {
- list = makeSplitPacket(data, chunksize_max, split_seqnum);
- split_seqnum++;
- return list;
- }
- list.push_back(makeOriginalPacket(data));
- return list;
- }
- SharedBuffer<u8> makeReliablePacket(
- const SharedBuffer<u8> &data,
- u16 seqnum)
- {
- u32 header_size = 3;
- u32 packet_size = data.getSize() + header_size;
- SharedBuffer<u8> b(packet_size);
- writeU8(&b[0], TYPE_RELIABLE);
- writeU16(&b[1], seqnum);
- memcpy(&b[header_size], *data, data.getSize());
- return b;
- }
- /*
- ReliablePacketBuffer
- */
- void ReliablePacketBuffer::print()
- {
- MutexAutoLock listlock(m_list_mutex);
- LOG(dout_con<<"Dump of ReliablePacketBuffer:" << std::endl);
- unsigned int index = 0;
- for (BufferedPacket &bufferedPacket : m_list) {
- u16 s = readU16(&(bufferedPacket.data[BASE_HEADER_SIZE+1]));
- LOG(dout_con<<index<< ":" << s << std::endl);
- index++;
- }
- }
- bool ReliablePacketBuffer::empty()
- {
- MutexAutoLock listlock(m_list_mutex);
- return m_list.empty();
- }
- u32 ReliablePacketBuffer::size()
- {
- return m_list_size;
- }
- bool ReliablePacketBuffer::containsPacket(u16 seqnum)
- {
- return !(findPacket(seqnum) == m_list.end());
- }
- RPBSearchResult ReliablePacketBuffer::findPacket(u16 seqnum)
- {
- std::list<BufferedPacket>::iterator i = m_list.begin();
- for(; i != m_list.end(); ++i)
- {
- u16 s = readU16(&(i->data[BASE_HEADER_SIZE+1]));
- /*dout_con<<"findPacket(): finding seqnum="<<seqnum
- <<", comparing to s="<<s<<std::endl;*/
- if (s == seqnum)
- break;
- }
- return i;
- }
- RPBSearchResult ReliablePacketBuffer::notFound()
- {
- return m_list.end();
- }
- bool ReliablePacketBuffer::getFirstSeqnum(u16& result)
- {
- MutexAutoLock listlock(m_list_mutex);
- if (m_list.empty())
- return false;
- BufferedPacket p = *m_list.begin();
- result = readU16(&p.data[BASE_HEADER_SIZE+1]);
- return true;
- }
- BufferedPacket ReliablePacketBuffer::popFirst()
- {
- MutexAutoLock listlock(m_list_mutex);
- if (m_list.empty())
- throw NotFoundException("Buffer is empty");
- BufferedPacket p = *m_list.begin();
- m_list.erase(m_list.begin());
- --m_list_size;
- if (m_list_size == 0) {
- m_oldest_non_answered_ack = 0;
- } else {
- m_oldest_non_answered_ack =
- readU16(&(*m_list.begin()).data[BASE_HEADER_SIZE+1]);
- }
- return p;
- }
- BufferedPacket ReliablePacketBuffer::popSeqnum(u16 seqnum)
- {
- MutexAutoLock listlock(m_list_mutex);
- RPBSearchResult r = findPacket(seqnum);
- if (r == notFound()) {
- LOG(dout_con<<"Sequence number: " << seqnum
- << " not found in reliable buffer"<<std::endl);
- throw NotFoundException("seqnum not found in buffer");
- }
- BufferedPacket p = *r;
- RPBSearchResult next = r;
- ++next;
- if (next != notFound()) {
- u16 s = readU16(&(next->data[BASE_HEADER_SIZE+1]));
- m_oldest_non_answered_ack = s;
- }
- m_list.erase(r);
- --m_list_size;
- if (m_list_size == 0)
- { m_oldest_non_answered_ack = 0; }
- else
- { m_oldest_non_answered_ack = readU16(&(*m_list.begin()).data[BASE_HEADER_SIZE+1]); }
- return p;
- }
- void ReliablePacketBuffer::insert(BufferedPacket &p,u16 next_expected)
- {
- MutexAutoLock listlock(m_list_mutex);
- if (p.data.getSize() < BASE_HEADER_SIZE + 3) {
- errorstream << "ReliablePacketBuffer::insert(): Invalid data size for "
- "reliable packet" << std::endl;
- return;
- }
- u8 type = readU8(&p.data[BASE_HEADER_SIZE + 0]);
- if (type != TYPE_RELIABLE) {
- errorstream << "ReliablePacketBuffer::insert(): type is not reliable"
- << std::endl;
- return;
- }
- u16 seqnum = readU16(&p.data[BASE_HEADER_SIZE + 1]);
- if (!seqnum_in_window(seqnum, next_expected, MAX_RELIABLE_WINDOW_SIZE)) {
- errorstream << "ReliablePacketBuffer::insert(): seqnum is outside of "
- "expected window " << std::endl;
- return;
- }
- if (seqnum == next_expected) {
- errorstream << "ReliablePacketBuffer::insert(): seqnum is next expected"
- << std::endl;
- return;
- }
- ++m_list_size;
- sanity_check(m_list_size <= SEQNUM_MAX+1); // FIXME: Handle the error?
- // Find the right place for the packet and insert it there
- // If list is empty, just add it
- if (m_list.empty())
- {
- m_list.push_back(p);
- m_oldest_non_answered_ack = seqnum;
- // Done.
- return;
- }
- // Otherwise find the right place
- std::list<BufferedPacket>::iterator i = m_list.begin();
- // Find the first packet in the list which has a higher seqnum
- u16 s = readU16(&(i->data[BASE_HEADER_SIZE+1]));
- /* case seqnum is smaller then next_expected seqnum */
- /* this is true e.g. on wrap around */
- if (seqnum < next_expected) {
- while(((s < seqnum) || (s >= next_expected)) && (i != m_list.end())) {
- ++i;
- if (i != m_list.end())
- s = readU16(&(i->data[BASE_HEADER_SIZE+1]));
- }
- }
- /* non wrap around case (at least for incoming and next_expected */
- else
- {
- while(((s < seqnum) && (s >= next_expected)) && (i != m_list.end())) {
- ++i;
- if (i != m_list.end())
- s = readU16(&(i->data[BASE_HEADER_SIZE+1]));
- }
- }
- if (s == seqnum) {
- if (
- (readU16(&(i->data[BASE_HEADER_SIZE+1])) != seqnum) ||
- (i->data.getSize() != p.data.getSize()) ||
- (i->address != p.address)
- )
- {
- /* if this happens your maximum transfer window may be to big */
- fprintf(stderr,
- "Duplicated seqnum %d non matching packet detected:\n",
- seqnum);
- fprintf(stderr, "Old: seqnum: %05d size: %04d, address: %s\n",
- readU16(&(i->data[BASE_HEADER_SIZE+1])),i->data.getSize(),
- i->address.serializeString().c_str());
- fprintf(stderr, "New: seqnum: %05d size: %04u, address: %s\n",
- readU16(&(p.data[BASE_HEADER_SIZE+1])),p.data.getSize(),
- p.address.serializeString().c_str());
- throw IncomingDataCorruption("duplicated packet isn't same as original one");
- }
- /* nothing to do this seems to be a resent packet */
- /* for paranoia reason data should be compared */
- --m_list_size;
- }
- /* insert or push back */
- else if (i != m_list.end()) {
- m_list.insert(i, p);
- }
- else {
- m_list.push_back(p);
- }
- /* update last packet number */
- m_oldest_non_answered_ack = readU16(&(*m_list.begin()).data[BASE_HEADER_SIZE+1]);
- }
- void ReliablePacketBuffer::incrementTimeouts(float dtime)
- {
- MutexAutoLock listlock(m_list_mutex);
- for (BufferedPacket &bufferedPacket : m_list) {
- bufferedPacket.time += dtime;
- bufferedPacket.totaltime += dtime;
- }
- }
- std::list<BufferedPacket> ReliablePacketBuffer::getTimedOuts(float timeout,
- unsigned int max_packets)
- {
- MutexAutoLock listlock(m_list_mutex);
- std::list<BufferedPacket> timed_outs;
- for (BufferedPacket &bufferedPacket : m_list) {
- if (bufferedPacket.time >= timeout) {
- timed_outs.push_back(bufferedPacket);
- //this packet will be sent right afterwards reset timeout here
- bufferedPacket.time = 0.0f;
- if (timed_outs.size() >= max_packets)
- break;
- }
- }
- return timed_outs;
- }
- /*
- IncomingSplitBuffer
- */
- IncomingSplitBuffer::~IncomingSplitBuffer()
- {
- MutexAutoLock listlock(m_map_mutex);
- for (auto &i : m_buf) {
- delete i.second;
- }
- }
- /*
- This will throw a GotSplitPacketException when a full
- split packet is constructed.
- */
- SharedBuffer<u8> IncomingSplitBuffer::insert(BufferedPacket &p, bool reliable)
- {
- MutexAutoLock listlock(m_map_mutex);
- u32 headersize = BASE_HEADER_SIZE + 7;
- if (p.data.getSize() < headersize) {
- errorstream << "Invalid data size for split packet" << std::endl;
- return SharedBuffer<u8>();
- }
- u8 type = readU8(&p.data[BASE_HEADER_SIZE+0]);
- u16 seqnum = readU16(&p.data[BASE_HEADER_SIZE+1]);
- u16 chunk_count = readU16(&p.data[BASE_HEADER_SIZE+3]);
- u16 chunk_num = readU16(&p.data[BASE_HEADER_SIZE+5]);
- if (type != TYPE_SPLIT) {
- errorstream << "IncomingSplitBuffer::insert(): type is not split"
- << std::endl;
- return SharedBuffer<u8>();
- }
- // Add if doesn't exist
- if (m_buf.find(seqnum) == m_buf.end())
- {
- IncomingSplitPacket *sp = new IncomingSplitPacket();
- sp->chunk_count = chunk_count;
- sp->reliable = reliable;
- m_buf[seqnum] = sp;
- }
- IncomingSplitPacket *sp = m_buf[seqnum];
- // TODO: These errors should be thrown or something? Dunno.
- if (chunk_count != sp->chunk_count)
- LOG(derr_con<<"Connection: WARNING: chunk_count="<<chunk_count
- <<" != sp->chunk_count="<<sp->chunk_count
- <<std::endl);
- if (reliable != sp->reliable)
- LOG(derr_con<<"Connection: WARNING: reliable="<<reliable
- <<" != sp->reliable="<<sp->reliable
- <<std::endl);
- // If chunk already exists, ignore it.
- // Sometimes two identical packets may arrive when there is network
- // lag and the server re-sends stuff.
- if (sp->chunks.find(chunk_num) != sp->chunks.end())
- return SharedBuffer<u8>();
- // Cut chunk data out of packet
- u32 chunkdatasize = p.data.getSize() - headersize;
- SharedBuffer<u8> chunkdata(chunkdatasize);
- memcpy(*chunkdata, &(p.data[headersize]), chunkdatasize);
- // Set chunk data in buffer
- sp->chunks[chunk_num] = chunkdata;
- // If not all chunks are received, return empty buffer
- if (!sp->allReceived())
- return SharedBuffer<u8>();
- // Calculate total size
- u32 totalsize = 0;
- for (const auto &chunk : sp->chunks) {
- totalsize += chunk.second.getSize();
- }
- SharedBuffer<u8> fulldata(totalsize);
- // Copy chunks to data buffer
- u32 start = 0;
- for(u32 chunk_i=0; chunk_i<sp->chunk_count;
- chunk_i++)
- {
- SharedBuffer<u8> buf = sp->chunks[chunk_i];
- u16 chunkdatasize = buf.getSize();
- memcpy(&fulldata[start], *buf, chunkdatasize);
- start += chunkdatasize;;
- }
- // Remove sp from buffer
- m_buf.erase(seqnum);
- delete sp;
- return fulldata;
- }
- void IncomingSplitBuffer::removeUnreliableTimedOuts(float dtime, float timeout)
- {
- std::list<u16> remove_queue;
- {
- MutexAutoLock listlock(m_map_mutex);
- for (auto &i : m_buf) {
- IncomingSplitPacket *p = i.second;
- // Reliable ones are not removed by timeout
- if (p->reliable)
- continue;
- p->time += dtime;
- if (p->time >= timeout)
- remove_queue.push_back(i.first);
- }
- }
- for (u16 j : remove_queue) {
- MutexAutoLock listlock(m_map_mutex);
- LOG(dout_con<<"NOTE: Removing timed out unreliable split packet"<<std::endl);
- delete m_buf[j];
- m_buf.erase(j);
- }
- }
- /*
- ConnectionCommand
- */
- void ConnectionCommand::send(u16 peer_id_, u8 channelnum_, NetworkPacket *pkt,
- bool reliable_)
- {
- type = CONNCMD_SEND;
- peer_id = peer_id_;
- channelnum = channelnum_;
- data = pkt->oldForgePacket();
- reliable = reliable_;
- }
- /*
- Channel
- */
- u16 Channel::readNextIncomingSeqNum()
- {
- MutexAutoLock internal(m_internal_mutex);
- return next_incoming_seqnum;
- }
- u16 Channel::incNextIncomingSeqNum()
- {
- MutexAutoLock internal(m_internal_mutex);
- u16 retval = next_incoming_seqnum;
- next_incoming_seqnum++;
- return retval;
- }
- u16 Channel::readNextSplitSeqNum()
- {
- MutexAutoLock internal(m_internal_mutex);
- return next_outgoing_split_seqnum;
- }
- void Channel::setNextSplitSeqNum(u16 seqnum)
- {
- MutexAutoLock internal(m_internal_mutex);
- next_outgoing_split_seqnum = seqnum;
- }
- u16 Channel::getOutgoingSequenceNumber(bool& successful)
- {
- MutexAutoLock internal(m_internal_mutex);
- u16 retval = next_outgoing_seqnum;
- u16 lowest_unacked_seqnumber;
- /* shortcut if there ain't any packet in outgoing list */
- if (outgoing_reliables_sent.empty())
- {
- next_outgoing_seqnum++;
- return retval;
- }
- if (outgoing_reliables_sent.getFirstSeqnum(lowest_unacked_seqnumber))
- {
- if (lowest_unacked_seqnumber < next_outgoing_seqnum) {
- // ugly cast but this one is required in order to tell compiler we
- // know about difference of two unsigned may be negative in general
- // but we already made sure it won't happen in this case
- if (((u16)(next_outgoing_seqnum - lowest_unacked_seqnumber)) > window_size) {
- successful = false;
- return 0;
- }
- }
- else {
- // ugly cast but this one is required in order to tell compiler we
- // know about difference of two unsigned may be negative in general
- // but we already made sure it won't happen in this case
- if ((next_outgoing_seqnum + (u16)(SEQNUM_MAX - lowest_unacked_seqnumber)) >
- window_size) {
- successful = false;
- return 0;
- }
- }
- }
- next_outgoing_seqnum++;
- return retval;
- }
- u16 Channel::readOutgoingSequenceNumber()
- {
- MutexAutoLock internal(m_internal_mutex);
- return next_outgoing_seqnum;
- }
- bool Channel::putBackSequenceNumber(u16 seqnum)
- {
- if (((seqnum + 1) % (SEQNUM_MAX+1)) == next_outgoing_seqnum) {
- next_outgoing_seqnum = seqnum;
- return true;
- }
- return false;
- }
- void Channel::UpdateBytesSent(unsigned int bytes, unsigned int packets)
- {
- MutexAutoLock internal(m_internal_mutex);
- current_bytes_transfered += bytes;
- current_packet_successfull += packets;
- }
- void Channel::UpdateBytesReceived(unsigned int bytes) {
- MutexAutoLock internal(m_internal_mutex);
- current_bytes_received += bytes;
- }
- void Channel::UpdateBytesLost(unsigned int bytes)
- {
- MutexAutoLock internal(m_internal_mutex);
- current_bytes_lost += bytes;
- }
- void Channel::UpdatePacketLossCounter(unsigned int count)
- {
- MutexAutoLock internal(m_internal_mutex);
- current_packet_loss += count;
- }
- void Channel::UpdatePacketTooLateCounter()
- {
- MutexAutoLock internal(m_internal_mutex);
- current_packet_too_late++;
- }
- void Channel::UpdateTimers(float dtime,bool legacy_peer)
- {
- bpm_counter += dtime;
- packet_loss_counter += dtime;
- if (packet_loss_counter > 1.0)
- {
- packet_loss_counter -= 1.0;
- unsigned int packet_loss = 11; /* use a neutral value for initialization */
- unsigned int packets_successfull = 0;
- //unsigned int packet_too_late = 0;
- bool reasonable_amount_of_data_transmitted = false;
- {
- MutexAutoLock internal(m_internal_mutex);
- packet_loss = current_packet_loss;
- //packet_too_late = current_packet_too_late;
- packets_successfull = current_packet_successfull;
- if (current_bytes_transfered > (unsigned int) (window_size*512/2))
- {
- reasonable_amount_of_data_transmitted = true;
- }
- current_packet_loss = 0;
- current_packet_too_late = 0;
- current_packet_successfull = 0;
- }
- /* dynamic window size is only available for non legacy peers */
- if (!legacy_peer) {
- float successfull_to_lost_ratio = 0.0;
- bool done = false;
- if (packets_successfull > 0) {
- successfull_to_lost_ratio = packet_loss/packets_successfull;
- }
- else if (packet_loss > 0)
- {
- window_size = MYMAX(
- (window_size - 10),
- MIN_RELIABLE_WINDOW_SIZE);
- done = true;
- }
- if (!done)
- {
- if ((successfull_to_lost_ratio < 0.01) &&
- (window_size < MAX_RELIABLE_WINDOW_SIZE))
- {
- /* don't even think about increasing if we didn't even
- * use major parts of our window */
- if (reasonable_amount_of_data_transmitted)
- window_size = MYMIN(
- (window_size + 100),
- MAX_RELIABLE_WINDOW_SIZE);
- }
- else if ((successfull_to_lost_ratio < 0.05) &&
- (window_size < MAX_RELIABLE_WINDOW_SIZE))
- {
- /* don't even think about increasing if we didn't even
- * use major parts of our window */
- if (reasonable_amount_of_data_transmitted)
- window_size = MYMIN(
- (window_size + 50),
- MAX_RELIABLE_WINDOW_SIZE);
- }
- else if (successfull_to_lost_ratio > 0.15)
- {
- window_size = MYMAX(
- (window_size - 100),
- MIN_RELIABLE_WINDOW_SIZE);
- }
- else if (successfull_to_lost_ratio > 0.1)
- {
- window_size = MYMAX(
- (window_size - 50),
- MIN_RELIABLE_WINDOW_SIZE);
- }
- }
- }
- }
- if (bpm_counter > 10.0)
- {
- {
- MutexAutoLock internal(m_internal_mutex);
- cur_kbps =
- (((float) current_bytes_transfered)/bpm_counter)/1024.0;
- current_bytes_transfered = 0;
- cur_kbps_lost =
- (((float) current_bytes_lost)/bpm_counter)/1024.0;
- current_bytes_lost = 0;
- cur_incoming_kbps =
- (((float) current_bytes_received)/bpm_counter)/1024.0;
- current_bytes_received = 0;
- bpm_counter = 0;
- }
- if (cur_kbps > max_kbps)
- {
- max_kbps = cur_kbps;
- }
- if (cur_kbps_lost > max_kbps_lost)
- {
- max_kbps_lost = cur_kbps_lost;
- }
- if (cur_incoming_kbps > max_incoming_kbps) {
- max_incoming_kbps = cur_incoming_kbps;
- }
- rate_samples = MYMIN(rate_samples+1,10);
- float old_fraction = ((float) (rate_samples-1) )/( (float) rate_samples);
- avg_kbps = avg_kbps * old_fraction +
- cur_kbps * (1.0 - old_fraction);
- avg_kbps_lost = avg_kbps_lost * old_fraction +
- cur_kbps_lost * (1.0 - old_fraction);
- avg_incoming_kbps = avg_incoming_kbps * old_fraction +
- cur_incoming_kbps * (1.0 - old_fraction);
- }
- }
- /*
- Peer
- */
- PeerHelper::PeerHelper(Peer* peer) :
- m_peer(peer)
- {
- if (peer && !peer->IncUseCount())
- m_peer = nullptr;
- }
- PeerHelper::~PeerHelper()
- {
- if (m_peer)
- m_peer->DecUseCount();
- m_peer = nullptr;
- }
- PeerHelper& PeerHelper::operator=(Peer* peer)
- {
- m_peer = peer;
- if (peer && !peer->IncUseCount())
- m_peer = nullptr;
- return *this;
- }
- Peer* PeerHelper::operator->() const
- {
- return m_peer;
- }
- Peer* PeerHelper::operator&() const
- {
- return m_peer;
- }
- bool PeerHelper::operator!() {
- return ! m_peer;
- }
- bool PeerHelper::operator!=(void* ptr)
- {
- return ((void*) m_peer != ptr);
- }
- bool Peer::IncUseCount()
- {
- MutexAutoLock lock(m_exclusive_access_mutex);
- if (!m_pending_deletion) {
- this->m_usage++;
- return true;
- }
- return false;
- }
- void Peer::DecUseCount()
- {
- {
- MutexAutoLock lock(m_exclusive_access_mutex);
- sanity_check(m_usage > 0);
- m_usage--;
- if (!((m_pending_deletion) && (m_usage == 0)))
- return;
- }
- delete this;
- }
- void Peer::RTTStatistics(float rtt, const std::string &profiler_id,
- unsigned int num_samples) {
- if (m_last_rtt > 0) {
- /* set min max values */
- if (rtt < m_rtt.min_rtt)
- m_rtt.min_rtt = rtt;
- if (rtt >= m_rtt.max_rtt)
- m_rtt.max_rtt = rtt;
- /* do average calculation */
- if (m_rtt.avg_rtt < 0.0)
- m_rtt.avg_rtt = rtt;
- else
- m_rtt.avg_rtt = m_rtt.avg_rtt * (num_samples/(num_samples-1)) +
- rtt * (1/num_samples);
- /* do jitter calculation */
- //just use some neutral value at beginning
- float jitter = m_rtt.jitter_min;
- if (rtt > m_last_rtt)
- jitter = rtt-m_last_rtt;
- if (rtt <= m_last_rtt)
- jitter = m_last_rtt - rtt;
- if (jitter < m_rtt.jitter_min)
- m_rtt.jitter_min = jitter;
- if (jitter >= m_rtt.jitter_max)
- m_rtt.jitter_max = jitter;
- if (m_rtt.jitter_avg < 0.0)
- m_rtt.jitter_avg = jitter;
- else
- m_rtt.jitter_avg = m_rtt.jitter_avg * (num_samples/(num_samples-1)) +
- jitter * (1/num_samples);
- if (!profiler_id.empty()) {
- g_profiler->graphAdd(profiler_id + "_rtt", rtt);
- g_profiler->graphAdd(profiler_id + "_jitter", jitter);
- }
- }
- /* save values required for next loop */
- m_last_rtt = rtt;
- }
- bool Peer::isTimedOut(float timeout)
- {
- MutexAutoLock lock(m_exclusive_access_mutex);
- u64 current_time = porting::getTimeMs();
- float dtime = CALC_DTIME(m_last_timeout_check,current_time);
- m_last_timeout_check = current_time;
- m_timeout_counter += dtime;
- return m_timeout_counter > timeout;
- }
- void Peer::Drop()
- {
- {
- MutexAutoLock usage_lock(m_exclusive_access_mutex);
- m_pending_deletion = true;
- if (m_usage != 0)
- return;
- }
- PROFILE(std::stringstream peerIdentifier1);
- PROFILE(peerIdentifier1 << "runTimeouts[" << m_connection->getDesc()
- << ";" << id << ";RELIABLE]");
- PROFILE(g_profiler->remove(peerIdentifier1.str()));
- PROFILE(std::stringstream peerIdentifier2);
- PROFILE(peerIdentifier2 << "sendPackets[" << m_connection->getDesc()
- << ";" << id << ";RELIABLE]");
- PROFILE(ScopeProfiler peerprofiler(g_profiler, peerIdentifier2.str(), SPT_AVG));
- delete this;
- }
- UDPPeer::UDPPeer(u16 a_id, Address a_address, Connection* connection) :
- Peer(a_address,a_id,connection)
- {
- }
- bool UDPPeer::getAddress(MTProtocols type,Address& toset)
- {
- if ((type == MTP_UDP) || (type == MTP_MINETEST_RELIABLE_UDP) || (type == MTP_PRIMARY))
- {
- toset = address;
- return true;
- }
- return false;
- }
- void UDPPeer::setNonLegacyPeer()
- {
- m_legacy_peer = false;
- for(unsigned int i=0; i< CHANNEL_COUNT; i++)
- {
- channels->setWindowSize(g_settings->getU16("max_packets_per_iteration"));
- }
- }
- void UDPPeer::reportRTT(float rtt)
- {
- if (rtt < 0.0) {
- return;
- }
- RTTStatistics(rtt,"rudp",MAX_RELIABLE_WINDOW_SIZE*10);
- float timeout = getStat(AVG_RTT) * RESEND_TIMEOUT_FACTOR;
- if (timeout < RESEND_TIMEOUT_MIN)
- timeout = RESEND_TIMEOUT_MIN;
- if (timeout > RESEND_TIMEOUT_MAX)
- timeout = RESEND_TIMEOUT_MAX;
- MutexAutoLock usage_lock(m_exclusive_access_mutex);
- resend_timeout = timeout;
- }
- bool UDPPeer::Ping(float dtime,SharedBuffer<u8>& data)
- {
- m_ping_timer += dtime;
- if (m_ping_timer >= PING_TIMEOUT)
- {
- // Create and send PING packet
- writeU8(&data[0], TYPE_CONTROL);
- writeU8(&data[1], CONTROLTYPE_PING);
- m_ping_timer = 0.0;
- return true;
- }
- return false;
- }
- void UDPPeer::PutReliableSendCommand(ConnectionCommand &c,
- unsigned int max_packet_size)
- {
- if (m_pending_disconnect)
- return;
- if ( channels[c.channelnum].queued_commands.empty() &&
- /* don't queue more packets then window size */
- (channels[c.channelnum].queued_reliables.size()
- < (channels[c.channelnum].getWindowSize()/2))) {
- LOG(dout_con<<m_connection->getDesc()
- <<" processing reliable command for peer id: " << c.peer_id
- <<" data size: " << c.data.getSize() << std::endl);
- if (!processReliableSendCommand(c,max_packet_size)) {
- channels[c.channelnum].queued_commands.push_back(c);
- }
- }
- else {
- LOG(dout_con<<m_connection->getDesc()
- <<" Queueing reliable command for peer id: " << c.peer_id
- <<" data size: " << c.data.getSize() <<std::endl);
- channels[c.channelnum].queued_commands.push_back(c);
- }
- }
- bool UDPPeer::processReliableSendCommand(
- ConnectionCommand &c,
- unsigned int max_packet_size)
- {
- if (m_pending_disconnect)
- return true;
- u32 chunksize_max = max_packet_size
- - BASE_HEADER_SIZE
- - RELIABLE_HEADER_SIZE;
- sanity_check(c.data.getSize() < MAX_RELIABLE_WINDOW_SIZE*512);
- std::list<SharedBuffer<u8> > originals;
- u16 split_sequence_number = channels[c.channelnum].readNextSplitSeqNum();
- if (c.raw)
- {
- originals.emplace_back(c.data);
- }
- else {
- originals = makeAutoSplitPacket(c.data, chunksize_max,split_sequence_number);
- channels[c.channelnum].setNextSplitSeqNum(split_sequence_number);
- }
- bool have_sequence_number = true;
- bool have_initial_sequence_number = false;
- std::queue<BufferedPacket> toadd;
- volatile u16 initial_sequence_number = 0;
- for (SharedBuffer<u8> &original : originals) {
- u16 seqnum = channels[c.channelnum].getOutgoingSequenceNumber(have_sequence_number);
- /* oops, we don't have enough sequence numbers to send this packet */
- if (!have_sequence_number)
- break;
- if (!have_initial_sequence_number)
- {
- initial_sequence_number = seqnum;
- have_initial_sequence_number = true;
- }
- SharedBuffer<u8> reliable = makeReliablePacket(original, seqnum);
- // Add base headers and make a packet
- BufferedPacket p = con::makePacket(address, reliable,
- m_connection->GetProtocolID(), m_connection->GetPeerID(),
- c.channelnum);
- toadd.push(p);
- }
- if (have_sequence_number) {
- volatile u16 pcount = 0;
- while (!toadd.empty()) {
- BufferedPacket p = toadd.front();
- toadd.pop();
- // LOG(dout_con<<connection->getDesc()
- // << " queuing reliable packet for peer_id: " << c.peer_id
- // << " channel: " << (c.channelnum&0xFF)
- // << " seqnum: " << readU16(&p.data[BASE_HEADER_SIZE+1])
- // << std::endl)
- channels[c.channelnum].queued_reliables.push(p);
- pcount++;
- }
- sanity_check(channels[c.channelnum].queued_reliables.size() < 0xFFFF);
- return true;
- }
- volatile u16 packets_available = toadd.size();
- /* we didn't get a single sequence number no need to fill queue */
- if (!have_initial_sequence_number) {
- return false;
- }
- while (!toadd.empty()) {
- /* remove packet */
- toadd.pop();
- bool successfully_put_back_sequence_number
- = channels[c.channelnum].putBackSequenceNumber(
- (initial_sequence_number+toadd.size() % (SEQNUM_MAX+1)));
- FATAL_ERROR_IF(!successfully_put_back_sequence_number, "error");
- }
- LOG(dout_con<<m_connection->getDesc()
- << " Windowsize exceeded on reliable sending "
- << c.data.getSize() << " bytes"
- << std::endl << "\t\tinitial_sequence_number: "
- << initial_sequence_number
- << std::endl << "\t\tgot at most : "
- << packets_available << " packets"
- << std::endl << "\t\tpackets queued : "
- << channels[c.channelnum].outgoing_reliables_sent.size()
- << std::endl);
- return false;
- }
- void UDPPeer::RunCommandQueues(
- unsigned int max_packet_size,
- unsigned int maxcommands,
- unsigned int maxtransfer)
- {
- for (Channel &channel : channels) {
- unsigned int commands_processed = 0;
- if ((!channel.queued_commands.empty()) &&
- (channel.queued_reliables.size() < maxtransfer) &&
- (commands_processed < maxcommands)) {
- try {
- ConnectionCommand c = channel.queued_commands.front();
- LOG(dout_con << m_connection->getDesc()
- << " processing queued reliable command " << std::endl);
- // Packet is processed, remove it from queue
- if (processReliableSendCommand(c,max_packet_size)) {
- channel.queued_commands.pop_front();
- } else {
- LOG(dout_con << m_connection->getDesc()
- << " Failed to queue packets for peer_id: " << c.peer_id
- << ", delaying sending of " << c.data.getSize()
- << " bytes" << std::endl);
- }
- }
- catch (ItemNotFoundException &e) {
- // intentionally empty
- }
- }
- }
- }
- u16 UDPPeer::getNextSplitSequenceNumber(u8 channel)
- {
- assert(channel < CHANNEL_COUNT); // Pre-condition
- return channels[channel].readNextSplitSeqNum();
- }
- void UDPPeer::setNextSplitSequenceNumber(u8 channel, u16 seqnum)
- {
- assert(channel < CHANNEL_COUNT); // Pre-condition
- channels[channel].setNextSplitSeqNum(seqnum);
- }
- SharedBuffer<u8> UDPPeer::addSpiltPacket(u8 channel,
- BufferedPacket toadd,
- bool reliable)
- {
- assert(channel < CHANNEL_COUNT); // Pre-condition
- return channels[channel].incoming_splits.insert(toadd,reliable);
- }
- /******************************************************************************/
- /* Connection Threads */
- /******************************************************************************/
- ConnectionSendThread::ConnectionSendThread(unsigned int max_packet_size,
- float timeout) :
- Thread("ConnectionSend"),
- m_max_packet_size(max_packet_size),
- m_timeout(timeout),
- m_max_data_packets_per_iteration(g_settings->getU16("max_packets_per_iteration"))
- {
- }
- void * ConnectionSendThread::run()
- {
- assert(m_connection);
- LOG(dout_con<<m_connection->getDesc()
- <<"ConnectionSend thread started"<<std::endl);
- u64 curtime = porting::getTimeMs();
- u64 lasttime = curtime;
- PROFILE(std::stringstream ThreadIdentifier);
- PROFILE(ThreadIdentifier << "ConnectionSend: [" << m_connection->getDesc() << "]");
- /* if stop is requested don't stop immediately but try to send all */
- /* packets first */
- while(!stopRequested() || packetsQueued()) {
- BEGIN_DEBUG_EXCEPTION_HANDLER
- PROFILE(ScopeProfiler sp(g_profiler, ThreadIdentifier.str(), SPT_AVG));
- m_iteration_packets_avaialble = m_max_data_packets_per_iteration;
- /* wait for trigger or timeout */
- m_send_sleep_semaphore.wait(50);
- /* remove all triggers */
- while(m_send_sleep_semaphore.wait(0)) {}
- lasttime = curtime;
- curtime = porting::getTimeMs();
- float dtime = CALC_DTIME(lasttime,curtime);
- /* first do all the reliable stuff */
- runTimeouts(dtime);
- /* translate commands to packets */
- ConnectionCommand c = m_connection->m_command_queue.pop_frontNoEx(0);
- while(c.type != CONNCMD_NONE)
- {
- if (c.reliable)
- processReliableCommand(c);
- else
- processNonReliableCommand(c);
- c = m_connection->m_command_queue.pop_frontNoEx(0);
- }
- /* send non reliable packets */
- sendPackets(dtime);
- END_DEBUG_EXCEPTION_HANDLER
- }
- PROFILE(g_profiler->remove(ThreadIdentifier.str()));
- return NULL;
- }
- void ConnectionSendThread::Trigger()
- {
- m_send_sleep_semaphore.post();
- }
- bool ConnectionSendThread::packetsQueued()
- {
- std::list<u16> peerIds = m_connection->getPeerIDs();
- if (!m_outgoing_queue.empty() && !peerIds.empty())
- return true;
- for (u16 peerId : peerIds) {
- PeerHelper peer = m_connection->getPeerNoEx(peerId);
- if (!peer)
- continue;
- if (dynamic_cast<UDPPeer*>(&peer) == 0)
- continue;
- for (Channel &channel : (dynamic_cast<UDPPeer *>(&peer))->channels) {
- if (!channel.queued_commands.empty()) {
- return true;
- }
- }
- }
- return false;
- }
- void ConnectionSendThread::runTimeouts(float dtime)
- {
- std::list<u16> timeouted_peers;
- std::list<u16> peerIds = m_connection->getPeerIDs();
- for (u16 &peerId : peerIds) {
- PeerHelper peer = m_connection->getPeerNoEx(peerId);
- if (!peer)
- continue;
- if (dynamic_cast<UDPPeer*>(&peer) == 0)
- continue;
- PROFILE(std::stringstream peerIdentifier);
- PROFILE(peerIdentifier << "runTimeouts[" << m_connection->getDesc()
- << ";" << peerId << ";RELIABLE]");
- PROFILE(ScopeProfiler peerprofiler(g_profiler, peerIdentifier.str(), SPT_AVG));
- SharedBuffer<u8> data(2); // data for sending ping, required here because of goto
- /*
- Check peer timeout
- */
- if (peer->isTimedOut(m_timeout))
- {
- infostream<<m_connection->getDesc()
- <<"RunTimeouts(): Peer "<<peer->id
- <<" has timed out."
- <<" (source=peer->timeout_counter)"
- <<std::endl;
- // Add peer to the list
- timeouted_peers.push_back(peer->id);
- // Don't bother going through the buffers of this one
- continue;
- }
- float resend_timeout = dynamic_cast<UDPPeer*>(&peer)->getResendTimeout();
- bool retry_count_exceeded = false;
- for (Channel &channel : (dynamic_cast<UDPPeer *>(&peer))->channels) {
- std::list<BufferedPacket> timed_outs;
- if (dynamic_cast<UDPPeer*>(&peer)->getLegacyPeer())
- channel.setWindowSize(g_settings->getU16("workaround_window_size"));
- // Remove timed out incomplete unreliable split packets
- channel.incoming_splits.removeUnreliableTimedOuts(dtime, m_timeout);
- // Increment reliable packet times
- channel.outgoing_reliables_sent.incrementTimeouts(dtime);
- unsigned int numpeers = m_connection->m_peers.size();
- if (numpeers == 0)
- return;
- // Re-send timed out outgoing reliables
- timed_outs = channel.outgoing_reliables_sent.getTimedOuts(resend_timeout,
- (m_max_data_packets_per_iteration/numpeers));
- channel.UpdatePacketLossCounter(timed_outs.size());
- g_profiler->graphAdd("packets_lost", timed_outs.size());
- m_iteration_packets_avaialble -= timed_outs.size();
- for(std::list<BufferedPacket>::iterator k = timed_outs.begin();
- k != timed_outs.end(); ++k)
- {
- u16 peer_id = readPeerId(*(k->data));
- u8 channelnum = readChannel(*(k->data));
- u16 seqnum = readU16(&(k->data[BASE_HEADER_SIZE+1]));
- channel.UpdateBytesLost(k->data.getSize());
- k->resend_count++;
- if (k-> resend_count > MAX_RELIABLE_RETRY) {
- retry_count_exceeded = true;
- timeouted_peers.push_back(peer->id);
- /* no need to check additional packets if a single one did timeout*/
- break;
- }
- LOG(derr_con<<m_connection->getDesc()
- <<"RE-SENDING timed-out RELIABLE to "
- << k->address.serializeString()
- << "(t/o="<<resend_timeout<<"): "
- <<"from_peer_id="<<peer_id
- <<", channel="<<((int)channelnum&0xff)
- <<", seqnum="<<seqnum
- <<std::endl);
- rawSend(*k);
- // do not handle rtt here as we can't decide if this packet was
- // lost or really takes more time to transmit
- }
- if (retry_count_exceeded) {
- break; /* no need to check other channels if we already did timeout */
- }
- channel.UpdateTimers(dtime,dynamic_cast<UDPPeer*>(&peer)->getLegacyPeer());
- }
- /* skip to next peer if we did timeout */
- if (retry_count_exceeded)
- continue;
- /* send ping if necessary */
- if (dynamic_cast<UDPPeer*>(&peer)->Ping(dtime,data)) {
- LOG(dout_con<<m_connection->getDesc()
- <<"Sending ping for peer_id: "
- << dynamic_cast<UDPPeer*>(&peer)->id <<std::endl);
- /* this may fail if there ain't a sequence number left */
- if (!rawSendAsPacket(dynamic_cast<UDPPeer*>(&peer)->id, 0, data, true))
- {
- //retrigger with reduced ping interval
- dynamic_cast<UDPPeer*>(&peer)->Ping(4.0,data);
- }
- }
- dynamic_cast<UDPPeer*>(&peer)->RunCommandQueues(m_max_packet_size,
- m_max_commands_per_iteration,
- m_max_packets_requeued);
- }
- // Remove timed out peers
- for (u16 timeouted_peer : timeouted_peers) {
- LOG(derr_con << m_connection->getDesc()
- << "RunTimeouts(): Removing peer "<< timeouted_peer <<std::endl);
- m_connection->deletePeer(timeouted_peer, true);
- }
- }
- void ConnectionSendThread::rawSend(const BufferedPacket &packet)
- {
- try{
- m_connection->m_udpSocket.Send(packet.address, *packet.data,
- packet.data.getSize());
- LOG(dout_con <<m_connection->getDesc()
- << " rawSend: " << packet.data.getSize()
- << " bytes sent" << std::endl);
- } catch(SendFailedException &e) {
- LOG(derr_con<<m_connection->getDesc()
- <<"Connection::rawSend(): SendFailedException: "
- <<packet.address.serializeString()<<std::endl);
- }
- }
- void ConnectionSendThread::sendAsPacketReliable(BufferedPacket& p, Channel* channel)
- {
- try{
- p.absolute_send_time = porting::getTimeMs();
- // Buffer the packet
- channel->outgoing_reliables_sent.insert(p,
- (channel->readOutgoingSequenceNumber() - MAX_RELIABLE_WINDOW_SIZE)
- % (MAX_RELIABLE_WINDOW_SIZE+1));
- }
- catch(AlreadyExistsException &e)
- {
- LOG(derr_con<<m_connection->getDesc()
- <<"WARNING: Going to send a reliable packet"
- <<" in outgoing buffer" <<std::endl);
- }
- // Send the packet
- rawSend(p);
- }
- bool ConnectionSendThread::rawSendAsPacket(u16 peer_id, u8 channelnum,
- SharedBuffer<u8> data, bool reliable)
- {
- PeerHelper peer = m_connection->getPeerNoEx(peer_id);
- if (!peer) {
- LOG(dout_con<<m_connection->getDesc()
- <<" INFO: dropped packet for non existent peer_id: "
- << peer_id << std::endl);
- FATAL_ERROR_IF(!reliable, "Trying to send raw packet reliable but no peer found!");
- return false;
- }
- Channel *channel = &(dynamic_cast<UDPPeer*>(&peer)->channels[channelnum]);
- if (reliable)
- {
- bool have_sequence_number_for_raw_packet = true;
- u16 seqnum =
- channel->getOutgoingSequenceNumber(have_sequence_number_for_raw_packet);
- if (!have_sequence_number_for_raw_packet)
- return false;
- SharedBuffer<u8> reliable = makeReliablePacket(data, seqnum);
- Address peer_address;
- peer->getAddress(MTP_MINETEST_RELIABLE_UDP, peer_address);
- // Add base headers and make a packet
- BufferedPacket p = con::makePacket(peer_address, reliable,
- m_connection->GetProtocolID(), m_connection->GetPeerID(),
- channelnum);
- // first check if our send window is already maxed out
- if (channel->outgoing_reliables_sent.size()
- < channel->getWindowSize()) {
- LOG(dout_con<<m_connection->getDesc()
- <<" INFO: sending a reliable packet to peer_id " << peer_id
- <<" channel: " << channelnum
- <<" seqnum: " << seqnum << std::endl);
- sendAsPacketReliable(p,channel);
- return true;
- }
- LOG(dout_con<<m_connection->getDesc()
- <<" INFO: queueing reliable packet for peer_id: " << peer_id
- <<" channel: " << channelnum
- <<" seqnum: " << seqnum << std::endl);
- channel->queued_reliables.push(p);
- return false;
- }
- Address peer_address;
- if (peer->getAddress(MTP_UDP, peer_address)) {
- // Add base headers and make a packet
- BufferedPacket p = con::makePacket(peer_address, data,
- m_connection->GetProtocolID(), m_connection->GetPeerID(),
- channelnum);
- // Send the packet
- rawSend(p);
- return true;
- }
- LOG(dout_con << m_connection->getDesc()
- << " INFO: dropped unreliable packet for peer_id: " << peer_id
- << " because of (yet) missing udp address" << std::endl);
- return false;
- }
- void ConnectionSendThread::processReliableCommand(ConnectionCommand &c)
- {
- assert(c.reliable); // Pre-condition
- switch(c.type) {
- case CONNCMD_NONE:
- LOG(dout_con<<m_connection->getDesc()
- <<"UDP processing reliable CONNCMD_NONE"<<std::endl);
- return;
- case CONNCMD_SEND:
- LOG(dout_con<<m_connection->getDesc()
- <<"UDP processing reliable CONNCMD_SEND"<<std::endl);
- sendReliable(c);
- return;
- case CONNCMD_SEND_TO_ALL:
- LOG(dout_con<<m_connection->getDesc()
- <<"UDP processing CONNCMD_SEND_TO_ALL"<<std::endl);
- sendToAllReliable(c);
- return;
- case CONCMD_CREATE_PEER:
- LOG(dout_con<<m_connection->getDesc()
- <<"UDP processing reliable CONCMD_CREATE_PEER"<<std::endl);
- if (!rawSendAsPacket(c.peer_id,c.channelnum,c.data,c.reliable))
- {
- /* put to queue if we couldn't send it immediately */
- sendReliable(c);
- }
- return;
- case CONCMD_DISABLE_LEGACY:
- LOG(dout_con<<m_connection->getDesc()
- <<"UDP processing reliable CONCMD_DISABLE_LEGACY"<<std::endl);
- if (!rawSendAsPacket(c.peer_id,c.channelnum,c.data,c.reliable))
- {
- /* put to queue if we couldn't send it immediately */
- sendReliable(c);
- }
- return;
- case CONNCMD_SERVE:
- case CONNCMD_CONNECT:
- case CONNCMD_DISCONNECT:
- case CONCMD_ACK:
- FATAL_ERROR("Got command that shouldn't be reliable as reliable command");
- default:
- LOG(dout_con<<m_connection->getDesc()
- <<" Invalid reliable command type: " << c.type <<std::endl);
- }
- }
- void ConnectionSendThread::processNonReliableCommand(ConnectionCommand &c)
- {
- assert(!c.reliable); // Pre-condition
- switch(c.type) {
- case CONNCMD_NONE:
- LOG(dout_con<<m_connection->getDesc()
- <<" UDP processing CONNCMD_NONE"<<std::endl);
- return;
- case CONNCMD_SERVE:
- LOG(dout_con<<m_connection->getDesc()
- <<" UDP processing CONNCMD_SERVE port="
- <<c.address.serializeString()<<std::endl);
- serve(c.address);
- return;
- case CONNCMD_CONNECT:
- LOG(dout_con<<m_connection->getDesc()
- <<" UDP processing CONNCMD_CONNECT"<<std::endl);
- connect(c.address);
- return;
- case CONNCMD_DISCONNECT:
- LOG(dout_con<<m_connection->getDesc()
- <<" UDP processing CONNCMD_DISCONNECT"<<std::endl);
- disconnect();
- return;
- case CONNCMD_DISCONNECT_PEER:
- LOG(dout_con<<m_connection->getDesc()
- <<" UDP processing CONNCMD_DISCONNECT_PEER"<<std::endl);
- disconnect_peer(c.peer_id);
- return;
- case CONNCMD_SEND:
- LOG(dout_con<<m_connection->getDesc()
- <<" UDP processing CONNCMD_SEND"<<std::endl);
- send(c.peer_id, c.channelnum, c.data);
- return;
- case CONNCMD_SEND_TO_ALL:
- LOG(dout_con<<m_connection->getDesc()
- <<" UDP processing CONNCMD_SEND_TO_ALL"<<std::endl);
- sendToAll(c.channelnum, c.data);
- return;
- case CONCMD_ACK:
- LOG(dout_con<<m_connection->getDesc()
- <<" UDP processing CONCMD_ACK"<<std::endl);
- sendAsPacket(c.peer_id,c.channelnum,c.data,true);
- return;
- case CONCMD_CREATE_PEER:
- FATAL_ERROR("Got command that should be reliable as unreliable command");
- default:
- LOG(dout_con<<m_connection->getDesc()
- <<" Invalid command type: " << c.type <<std::endl);
- }
- }
- void ConnectionSendThread::serve(Address bind_address)
- {
- LOG(dout_con<<m_connection->getDesc()
- <<"UDP serving at port " << bind_address.serializeString() <<std::endl);
- try{
- m_connection->m_udpSocket.Bind(bind_address);
- m_connection->SetPeerID(PEER_ID_SERVER);
- }
- catch(SocketException &e) {
- // Create event
- ConnectionEvent ce;
- ce.bindFailed();
- m_connection->putEvent(ce);
- }
- }
- void ConnectionSendThread::connect(Address address)
- {
- LOG(dout_con<<m_connection->getDesc()<<" connecting to "<<address.serializeString()
- <<":"<<address.getPort()<<std::endl);
- UDPPeer *peer = m_connection->createServerPeer(address);
- // Create event
- ConnectionEvent e;
- e.peerAdded(peer->id, peer->address);
- m_connection->putEvent(e);
- Address bind_addr;
- if (address.isIPv6())
- bind_addr.setAddress((IPv6AddressBytes*) NULL);
- else
- bind_addr.setAddress(0,0,0,0);
- m_connection->m_udpSocket.Bind(bind_addr);
- // Send a dummy packet to server with peer_id = PEER_ID_INEXISTENT
- m_connection->SetPeerID(PEER_ID_INEXISTENT);
- NetworkPacket pkt(0,0);
- m_connection->Send(PEER_ID_SERVER, 0, &pkt, true);
- }
- void ConnectionSendThread::disconnect()
- {
- LOG(dout_con<<m_connection->getDesc()<<" disconnecting"<<std::endl);
- // Create and send DISCO packet
- SharedBuffer<u8> data(2);
- writeU8(&data[0], TYPE_CONTROL);
- writeU8(&data[1], CONTROLTYPE_DISCO);
- // Send to all
- std::list<u16> peerids = m_connection->getPeerIDs();
- for (u16 peerid : peerids) {
- sendAsPacket(peerid, 0,data,false);
- }
- }
- void ConnectionSendThread::disconnect_peer(u16 peer_id)
- {
- LOG(dout_con<<m_connection->getDesc()<<" disconnecting peer"<<std::endl);
- // Create and send DISCO packet
- SharedBuffer<u8> data(2);
- writeU8(&data[0], TYPE_CONTROL);
- writeU8(&data[1], CONTROLTYPE_DISCO);
- sendAsPacket(peer_id, 0,data,false);
- PeerHelper peer = m_connection->getPeerNoEx(peer_id);
- if (!peer)
- return;
- if (dynamic_cast<UDPPeer*>(&peer) == 0)
- {
- return;
- }
- dynamic_cast<UDPPeer*>(&peer)->m_pending_disconnect = true;
- }
- void ConnectionSendThread::send(u16 peer_id, u8 channelnum,
- SharedBuffer<u8> data)
- {
- assert(channelnum < CHANNEL_COUNT); // Pre-condition
- PeerHelper peer = m_connection->getPeerNoEx(peer_id);
- if (!peer)
- {
- LOG(dout_con<<m_connection->getDesc()<<" peer: peer_id="<<peer_id
- << ">>>NOT<<< found on sending packet"
- << ", channel " << (channelnum % 0xFF)
- << ", size: " << data.getSize() <<std::endl);
- return;
- }
- LOG(dout_con<<m_connection->getDesc()<<" sending to peer_id="<<peer_id
- << ", channel " << (channelnum % 0xFF)
- << ", size: " << data.getSize() <<std::endl);
- u16 split_sequence_number = peer->getNextSplitSequenceNumber(channelnum);
- u32 chunksize_max = m_max_packet_size - BASE_HEADER_SIZE;
- std::list<SharedBuffer<u8> > originals;
- originals = makeAutoSplitPacket(data, chunksize_max,split_sequence_number);
- peer->setNextSplitSequenceNumber(channelnum,split_sequence_number);
- for (const SharedBuffer<u8> &original : originals) {
- sendAsPacket(peer_id, channelnum, original);
- }
- }
- void ConnectionSendThread::sendReliable(ConnectionCommand &c)
- {
- PeerHelper peer = m_connection->getPeerNoEx(c.peer_id);
- if (!peer)
- return;
- peer->PutReliableSendCommand(c,m_max_packet_size);
- }
- void ConnectionSendThread::sendToAll(u8 channelnum, SharedBuffer<u8> data)
- {
- std::list<u16> peerids = m_connection->getPeerIDs();
- for (u16 peerid : peerids) {
- send(peerid, channelnum, data);
- }
- }
- void ConnectionSendThread::sendToAllReliable(ConnectionCommand &c)
- {
- std::list<u16> peerids = m_connection->getPeerIDs();
- for (u16 peerid : peerids) {
- PeerHelper peer = m_connection->getPeerNoEx(peerid);
- if (!peer)
- continue;
- peer->PutReliableSendCommand(c,m_max_packet_size);
- }
- }
- void ConnectionSendThread::sendPackets(float dtime)
- {
- std::list<u16> peerIds = m_connection->getPeerIDs();
- std::list<u16> pendingDisconnect;
- std::map<u16,bool> pending_unreliable;
- for (u16 peerId : peerIds) {
- PeerHelper peer = m_connection->getPeerNoEx(peerId);
- //peer may have been removed
- if (!peer) {
- LOG(dout_con<<m_connection->getDesc()<< " Peer not found: peer_id=" << peerId
- << std::endl);
- continue;
- }
- peer->m_increment_packets_remaining = m_iteration_packets_avaialble/m_connection->m_peers.size();
- UDPPeer *udpPeer = dynamic_cast<UDPPeer*>(&peer);
- if (!udpPeer) {
- continue;
- }
- if (udpPeer->m_pending_disconnect) {
- pendingDisconnect.push_back(peerId);
- }
- PROFILE(std::stringstream peerIdentifier);
- PROFILE(peerIdentifier << "sendPackets[" << m_connection->getDesc() << ";" << peerId
- << ";RELIABLE]");
- PROFILE(ScopeProfiler peerprofiler(g_profiler, peerIdentifier.str(), SPT_AVG));
- LOG(dout_con<<m_connection->getDesc()
- << " Handle per peer queues: peer_id=" << peerId
- << " packet quota: " << peer->m_increment_packets_remaining << std::endl);
- // first send queued reliable packets for all peers (if possible)
- for (unsigned int i=0; i < CHANNEL_COUNT; i++) {
- Channel &channel = udpPeer->channels[i];
- u16 next_to_ack = 0;
- channel.outgoing_reliables_sent.getFirstSeqnum(next_to_ack);
- u16 next_to_receive = 0;
- channel.incoming_reliables.getFirstSeqnum(next_to_receive);
- LOG(dout_con<<m_connection->getDesc()<< "\t channel: "
- << i << ", peer quota:"
- << peer->m_increment_packets_remaining
- << std::endl
- << "\t\t\treliables on wire: "
- << channel.outgoing_reliables_sent.size()
- << ", waiting for ack for " << next_to_ack
- << std::endl
- << "\t\t\tincoming_reliables: "
- << channel.incoming_reliables.size()
- << ", next reliable packet: "
- << channel.readNextIncomingSeqNum()
- << ", next queued: " << next_to_receive
- << std::endl
- << "\t\t\treliables queued : "
- << channel.queued_reliables.size()
- << std::endl
- << "\t\t\tqueued commands : "
- << channel.queued_commands.size()
- << std::endl);
- while ((!channel.queued_reliables.empty()) &&
- (channel.outgoing_reliables_sent.size()
- < channel.getWindowSize())&&
- (peer->m_increment_packets_remaining > 0))
- {
- BufferedPacket p = channel.queued_reliables.front();
- channel.queued_reliables.pop();
- LOG(dout_con<<m_connection->getDesc()
- <<" INFO: sending a queued reliable packet "
- <<" channel: " << i
- <<", seqnum: " << readU16(&p.data[BASE_HEADER_SIZE+1])
- << std::endl);
- sendAsPacketReliable(p, &channel);
- peer->m_increment_packets_remaining--;
- }
- }
- }
- if (!m_outgoing_queue.empty()) {
- LOG(dout_con<<m_connection->getDesc()
- << " Handle non reliable queue ("
- << m_outgoing_queue.size() << " pkts)" << std::endl);
- }
- unsigned int initial_queuesize = m_outgoing_queue.size();
- /* send non reliable packets*/
- for(unsigned int i=0;i < initial_queuesize;i++) {
- OutgoingPacket packet = m_outgoing_queue.front();
- m_outgoing_queue.pop();
- if (packet.reliable)
- continue;
- PeerHelper peer = m_connection->getPeerNoEx(packet.peer_id);
- if (!peer) {
- LOG(dout_con<<m_connection->getDesc()
- <<" Outgoing queue: peer_id="<<packet.peer_id
- << ">>>NOT<<< found on sending packet"
- << ", channel " << (packet.channelnum % 0xFF)
- << ", size: " << packet.data.getSize() <<std::endl);
- continue;
- }
- /* send acks immediately */
- if (packet.ack) {
- rawSendAsPacket(packet.peer_id, packet.channelnum,
- packet.data, packet.reliable);
- peer->m_increment_packets_remaining =
- MYMIN(0,peer->m_increment_packets_remaining--);
- }
- else if (
- ( peer->m_increment_packets_remaining > 0) ||
- (stopRequested())) {
- rawSendAsPacket(packet.peer_id, packet.channelnum,
- packet.data, packet.reliable);
- peer->m_increment_packets_remaining--;
- }
- else {
- m_outgoing_queue.push(packet);
- pending_unreliable[packet.peer_id] = true;
- }
- }
- for (u16 peerId : pendingDisconnect) {
- if (!pending_unreliable[peerId])
- {
- m_connection->deletePeer(peerId,false);
- }
- }
- }
- void ConnectionSendThread::sendAsPacket(u16 peer_id, u8 channelnum,
- SharedBuffer<u8> data, bool ack)
- {
- OutgoingPacket packet(peer_id, channelnum, data, false, ack);
- m_outgoing_queue.push(packet);
- }
- ConnectionReceiveThread::ConnectionReceiveThread(unsigned int max_packet_size) :
- Thread("ConnectionReceive")
- {
- }
- void * ConnectionReceiveThread::run()
- {
- assert(m_connection);
- LOG(dout_con<<m_connection->getDesc()
- <<"ConnectionReceive thread started"<<std::endl);
- PROFILE(std::stringstream ThreadIdentifier);
- PROFILE(ThreadIdentifier << "ConnectionReceive: [" << m_connection->getDesc() << "]");
- #ifdef DEBUG_CONNECTION_KBPS
- u64 curtime = porting::getTimeMs();
- u64 lasttime = curtime;
- float debug_print_timer = 0.0;
- #endif
- while(!stopRequested()) {
- BEGIN_DEBUG_EXCEPTION_HANDLER
- PROFILE(ScopeProfiler sp(g_profiler, ThreadIdentifier.str(), SPT_AVG));
- #ifdef DEBUG_CONNECTION_KBPS
- lasttime = curtime;
- curtime = porting::getTimeMs();
- float dtime = CALC_DTIME(lasttime,curtime);
- #endif
- /* receive packets */
- receive();
- #ifdef DEBUG_CONNECTION_KBPS
- debug_print_timer += dtime;
- if (debug_print_timer > 20.0) {
- debug_print_timer -= 20.0;
- std::list<u16> peerids = m_connection->getPeerIDs();
- for (std::list<u16>::iterator i = peerids.begin();
- i != peerids.end();
- i++)
- {
- PeerHelper peer = m_connection->getPeerNoEx(*i);
- if (!peer)
- continue;
- float peer_current = 0.0;
- float peer_loss = 0.0;
- float avg_rate = 0.0;
- float avg_loss = 0.0;
- for(u16 j=0; j<CHANNEL_COUNT; j++)
- {
- peer_current +=peer->channels[j].getCurrentDownloadRateKB();
- peer_loss += peer->channels[j].getCurrentLossRateKB();
- avg_rate += peer->channels[j].getAvgDownloadRateKB();
- avg_loss += peer->channels[j].getAvgLossRateKB();
- }
- std::stringstream output;
- output << std::fixed << std::setprecision(1);
- output << "OUT to Peer " << *i << " RATES (good / loss) " << std::endl;
- output << "\tcurrent (sum): " << peer_current << "kb/s "<< peer_loss << "kb/s" << std::endl;
- output << "\taverage (sum): " << avg_rate << "kb/s "<< avg_loss << "kb/s" << std::endl;
- output << std::setfill(' ');
- for(u16 j=0; j<CHANNEL_COUNT; j++)
- {
- output << "\tcha " << j << ":"
- << " CUR: " << std::setw(6) << peer->channels[j].getCurrentDownloadRateKB() <<"kb/s"
- << " AVG: " << std::setw(6) << peer->channels[j].getAvgDownloadRateKB() <<"kb/s"
- << " MAX: " << std::setw(6) << peer->channels[j].getMaxDownloadRateKB() <<"kb/s"
- << " /"
- << " CUR: " << std::setw(6) << peer->channels[j].getCurrentLossRateKB() <<"kb/s"
- << " AVG: " << std::setw(6) << peer->channels[j].getAvgLossRateKB() <<"kb/s"
- << " MAX: " << std::setw(6) << peer->channels[j].getMaxLossRateKB() <<"kb/s"
- << " / WS: " << peer->channels[j].getWindowSize()
- << std::endl;
- }
- fprintf(stderr,"%s\n",output.str().c_str());
- }
- }
- #endif
- END_DEBUG_EXCEPTION_HANDLER
- }
- PROFILE(g_profiler->remove(ThreadIdentifier.str()));
- return NULL;
- }
- // Receive packets from the network and buffers and create ConnectionEvents
- void ConnectionReceiveThread::receive()
- {
- // use IPv6 minimum allowed MTU as receive buffer size as this is
- // theoretical reliable upper boundary of a udp packet for all IPv6 enabled
- // infrastructure
- unsigned int packet_maxsize = 1500;
- SharedBuffer<u8> packetdata(packet_maxsize);
- bool packet_queued = true;
- unsigned int loop_count = 0;
- /* first of all read packets from socket */
- /* check for incoming data available */
- while( (loop_count < 10) &&
- (m_connection->m_udpSocket.WaitData(50))) {
- loop_count++;
- try {
- if (packet_queued) {
- bool data_left = true;
- u16 peer_id;
- SharedBuffer<u8> resultdata;
- while(data_left) {
- try {
- data_left = getFromBuffers(peer_id, resultdata);
- if (data_left) {
- ConnectionEvent e;
- e.dataReceived(peer_id, resultdata);
- m_connection->putEvent(e);
- }
- }
- catch(ProcessedSilentlyException &e) {
- /* try reading again */
- }
- }
- packet_queued = false;
- }
- Address sender;
- s32 received_size = m_connection->m_udpSocket.Receive(sender, *packetdata, packet_maxsize);
- if ((received_size < BASE_HEADER_SIZE) ||
- (readU32(&packetdata[0]) != m_connection->GetProtocolID()))
- {
- LOG(derr_con<<m_connection->getDesc()
- <<"Receive(): Invalid incoming packet, "
- <<"size: " << received_size
- <<", protocol: "
- << ((received_size >= 4) ? readU32(&packetdata[0]) : -1)
- << std::endl);
- continue;
- }
- u16 peer_id = readPeerId(*packetdata);
- u8 channelnum = readChannel(*packetdata);
- if (channelnum > CHANNEL_COUNT-1) {
- LOG(derr_con<<m_connection->getDesc()
- <<"Receive(): Invalid channel "<<channelnum<<std::endl);
- throw InvalidIncomingDataException("Channel doesn't exist");
- }
- /* Try to identify peer by sender address (may happen on join) */
- if (peer_id == PEER_ID_INEXISTENT) {
- peer_id = m_connection->lookupPeer(sender);
- // We do not have to remind the peer of its
- // peer id as the CONTROLTYPE_SET_PEER_ID
- // command was sent reliably.
- }
- /* The peer was not found in our lists. Add it. */
- if (peer_id == PEER_ID_INEXISTENT) {
- peer_id = m_connection->createPeer(sender, MTP_MINETEST_RELIABLE_UDP, 0);
- }
- PeerHelper peer = m_connection->getPeerNoEx(peer_id);
- if (!peer) {
- LOG(dout_con<<m_connection->getDesc()
- <<" got packet from unknown peer_id: "
- <<peer_id<<" Ignoring."<<std::endl);
- continue;
- }
- // Validate peer address
- Address peer_address;
- if (peer->getAddress(MTP_UDP, peer_address)) {
- if (peer_address != sender) {
- LOG(derr_con<<m_connection->getDesc()
- <<m_connection->getDesc()
- <<" Peer "<<peer_id<<" sending from different address."
- " Ignoring."<<std::endl);
- continue;
- }
- }
- else {
- bool invalid_address = true;
- if (invalid_address) {
- LOG(derr_con<<m_connection->getDesc()
- <<m_connection->getDesc()
- <<" Peer "<<peer_id<<" unknown."
- " Ignoring."<<std::endl);
- continue;
- }
- }
- peer->ResetTimeout();
- Channel *channel = 0;
- if (dynamic_cast<UDPPeer*>(&peer) != 0)
- {
- channel = &(dynamic_cast<UDPPeer*>(&peer)->channels[channelnum]);
- }
- if (channel != 0) {
- channel->UpdateBytesReceived(received_size);
- }
- // Throw the received packet to channel->processPacket()
- // Make a new SharedBuffer from the data without the base headers
- SharedBuffer<u8> strippeddata(received_size - BASE_HEADER_SIZE);
- memcpy(*strippeddata, &packetdata[BASE_HEADER_SIZE],
- strippeddata.getSize());
- try{
- // Process it (the result is some data with no headers made by us)
- SharedBuffer<u8> resultdata = processPacket
- (channel, strippeddata, peer_id, channelnum, false);
- LOG(dout_con<<m_connection->getDesc()
- <<" ProcessPacket from peer_id: " << peer_id
- << ",channel: " << (channelnum & 0xFF) << ", returned "
- << resultdata.getSize() << " bytes" <<std::endl);
- ConnectionEvent e;
- e.dataReceived(peer_id, resultdata);
- m_connection->putEvent(e);
- }
- catch(ProcessedSilentlyException &e) {
- }
- catch(ProcessedQueued &e) {
- packet_queued = true;
- }
- }
- catch(InvalidIncomingDataException &e) {
- }
- catch(ProcessedSilentlyException &e) {
- }
- }
- }
- bool ConnectionReceiveThread::getFromBuffers(u16 &peer_id, SharedBuffer<u8> &dst)
- {
- std::list<u16> peerids = m_connection->getPeerIDs();
- for (u16 peerid : peerids) {
- PeerHelper peer = m_connection->getPeerNoEx(peerid);
- if (!peer)
- continue;
- if (dynamic_cast<UDPPeer*>(&peer) == 0)
- continue;
- for (Channel &channel : (dynamic_cast<UDPPeer *>(&peer))->channels) {
- if (checkIncomingBuffers(&channel, peer_id, dst)) {
- return true;
- }
- }
- }
- return false;
- }
- bool ConnectionReceiveThread::checkIncomingBuffers(Channel *channel,
- u16 &peer_id, SharedBuffer<u8> &dst)
- {
- u16 firstseqnum = 0;
- if (channel->incoming_reliables.getFirstSeqnum(firstseqnum))
- {
- if (firstseqnum == channel->readNextIncomingSeqNum())
- {
- BufferedPacket p = channel->incoming_reliables.popFirst();
- peer_id = readPeerId(*p.data);
- u8 channelnum = readChannel(*p.data);
- u16 seqnum = readU16(&p.data[BASE_HEADER_SIZE+1]);
- LOG(dout_con<<m_connection->getDesc()
- <<"UNBUFFERING TYPE_RELIABLE"
- <<" seqnum="<<seqnum
- <<" peer_id="<<peer_id
- <<" channel="<<((int)channelnum&0xff)
- <<std::endl);
- channel->incNextIncomingSeqNum();
- u32 headers_size = BASE_HEADER_SIZE + RELIABLE_HEADER_SIZE;
- // Get out the inside packet and re-process it
- SharedBuffer<u8> payload(p.data.getSize() - headers_size);
- memcpy(*payload, &p.data[headers_size], payload.getSize());
- dst = processPacket(channel, payload, peer_id, channelnum, true);
- return true;
- }
- }
- return false;
- }
- SharedBuffer<u8> ConnectionReceiveThread::processPacket(Channel *channel,
- SharedBuffer<u8> packetdata, u16 peer_id, u8 channelnum, bool reliable)
- {
- PeerHelper peer = m_connection->getPeerNoEx(peer_id);
- if (!peer) {
- errorstream << "Peer not found (possible timeout)" << std::endl;
- throw ProcessedSilentlyException("Peer not found (possible timeout)");
- }
- if (packetdata.getSize() < 1)
- throw InvalidIncomingDataException("packetdata.getSize() < 1");
- u8 type = readU8(&(packetdata[0]));
- if (MAX_UDP_PEERS <= 65535 && peer_id >= MAX_UDP_PEERS) {
- std::string errmsg = "Invalid peer_id=" + itos(peer_id);
- errorstream << errmsg << std::endl;
- throw InvalidIncomingDataException(errmsg.c_str());
- }
- if (type == TYPE_CONTROL)
- {
- if (packetdata.getSize() < 2)
- throw InvalidIncomingDataException("packetdata.getSize() < 2");
- u8 controltype = readU8(&(packetdata[1]));
- if (controltype == CONTROLTYPE_ACK)
- {
- assert(channel != NULL);
- if (packetdata.getSize() < 4) {
- throw InvalidIncomingDataException(
- "packetdata.getSize() < 4 (ACK header size)");
- }
- u16 seqnum = readU16(&packetdata[2]);
- LOG(dout_con<<m_connection->getDesc()
- <<" [ CONTROLTYPE_ACK: channelnum="
- <<((int)channelnum&0xff)<<", peer_id="<<peer_id
- <<", seqnum="<<seqnum<< " ]"<<std::endl);
- try{
- BufferedPacket p =
- channel->outgoing_reliables_sent.popSeqnum(seqnum);
- // only calculate rtt from straight sent packets
- if (p.resend_count == 0) {
- // Get round trip time
- u64 current_time = porting::getTimeMs();
- // a overflow is quite unlikely but as it'd result in major
- // rtt miscalculation we handle it here
- if (current_time > p.absolute_send_time)
- {
- float rtt = (current_time - p.absolute_send_time) / 1000.0;
- // Let peer calculate stuff according to it
- // (avg_rtt and resend_timeout)
- dynamic_cast<UDPPeer*>(&peer)->reportRTT(rtt);
- }
- else if (p.totaltime > 0)
- {
- float rtt = p.totaltime;
- // Let peer calculate stuff according to it
- // (avg_rtt and resend_timeout)
- dynamic_cast<UDPPeer*>(&peer)->reportRTT(rtt);
- }
- }
- //put bytes for max bandwidth calculation
- channel->UpdateBytesSent(p.data.getSize(),1);
- if (channel->outgoing_reliables_sent.size() == 0)
- {
- m_connection->TriggerSend();
- }
- }
- catch(NotFoundException &e) {
- LOG(derr_con<<m_connection->getDesc()
- <<"WARNING: ACKed packet not "
- "in outgoing queue"
- <<std::endl);
- channel->UpdatePacketTooLateCounter();
- }
- throw ProcessedSilentlyException("Got an ACK");
- }
- else if (controltype == CONTROLTYPE_SET_PEER_ID) {
- // Got a packet to set our peer id
- if (packetdata.getSize() < 4)
- throw InvalidIncomingDataException
- ("packetdata.getSize() < 4 (SET_PEER_ID header size)");
- u16 peer_id_new = readU16(&packetdata[2]);
- LOG(dout_con<<m_connection->getDesc()
- <<"Got new peer id: "<<peer_id_new<<"... "<<std::endl);
- if (m_connection->GetPeerID() != PEER_ID_INEXISTENT)
- {
- LOG(derr_con<<m_connection->getDesc()
- <<"WARNING: Not changing"
- " existing peer id."<<std::endl);
- }
- else
- {
- LOG(dout_con<<m_connection->getDesc()<<"changing own peer id"<<std::endl);
- m_connection->SetPeerID(peer_id_new);
- }
- ConnectionCommand cmd;
- SharedBuffer<u8> reply(2);
- writeU8(&reply[0], TYPE_CONTROL);
- writeU8(&reply[1], CONTROLTYPE_ENABLE_BIG_SEND_WINDOW);
- cmd.disableLegacy(PEER_ID_SERVER,reply);
- m_connection->putCommand(cmd);
- throw ProcessedSilentlyException("Got a SET_PEER_ID");
- }
- else if (controltype == CONTROLTYPE_PING)
- {
- // Just ignore it, the incoming data already reset
- // the timeout counter
- LOG(dout_con<<m_connection->getDesc()<<"PING"<<std::endl);
- throw ProcessedSilentlyException("Got a PING");
- }
- else if (controltype == CONTROLTYPE_DISCO)
- {
- // Just ignore it, the incoming data already reset
- // the timeout counter
- LOG(dout_con<<m_connection->getDesc()
- <<"DISCO: Removing peer "<<(peer_id)<<std::endl);
- if (!m_connection->deletePeer(peer_id, false)) {
- derr_con<<m_connection->getDesc()
- <<"DISCO: Peer not found"<<std::endl;
- }
- throw ProcessedSilentlyException("Got a DISCO");
- }
- else if (controltype == CONTROLTYPE_ENABLE_BIG_SEND_WINDOW)
- {
- dynamic_cast<UDPPeer*>(&peer)->setNonLegacyPeer();
- throw ProcessedSilentlyException("Got non legacy control");
- }
- else{
- LOG(derr_con<<m_connection->getDesc()
- <<"INVALID TYPE_CONTROL: invalid controltype="
- <<((int)controltype&0xff)<<std::endl);
- throw InvalidIncomingDataException("Invalid control type");
- }
- }
- else if (type == TYPE_ORIGINAL)
- {
- if (packetdata.getSize() <= ORIGINAL_HEADER_SIZE)
- throw InvalidIncomingDataException
- ("packetdata.getSize() <= ORIGINAL_HEADER_SIZE");
- LOG(dout_con<<m_connection->getDesc()
- <<"RETURNING TYPE_ORIGINAL to user"
- <<std::endl);
- // Get the inside packet out and return it
- SharedBuffer<u8> payload(packetdata.getSize() - ORIGINAL_HEADER_SIZE);
- memcpy(*payload, &(packetdata[ORIGINAL_HEADER_SIZE]), payload.getSize());
- return payload;
- }
- else if (type == TYPE_SPLIT)
- {
- Address peer_address;
- if (peer->getAddress(MTP_UDP, peer_address)) {
- // We have to create a packet again for buffering
- // This isn't actually too bad an idea.
- BufferedPacket packet = makePacket(
- peer_address,
- packetdata,
- m_connection->GetProtocolID(),
- peer_id,
- channelnum);
- // Buffer the packet
- SharedBuffer<u8> data =
- peer->addSpiltPacket(channelnum,packet,reliable);
- if (data.getSize() != 0)
- {
- LOG(dout_con<<m_connection->getDesc()
- <<"RETURNING TYPE_SPLIT: Constructed full data, "
- <<"size="<<data.getSize()<<std::endl);
- return data;
- }
- LOG(dout_con<<m_connection->getDesc()<<"BUFFERED TYPE_SPLIT"<<std::endl);
- throw ProcessedSilentlyException("Buffered a split packet chunk");
- }
- else {
- //TODO throw some error
- }
- }
- else if (type == TYPE_RELIABLE)
- {
- assert(channel != NULL);
- // Recursive reliable packets not allowed
- if (reliable)
- throw InvalidIncomingDataException("Found nested reliable packets");
- if (packetdata.getSize() < RELIABLE_HEADER_SIZE)
- throw InvalidIncomingDataException
- ("packetdata.getSize() < RELIABLE_HEADER_SIZE");
- u16 seqnum = readU16(&packetdata[1]);
- bool is_future_packet = false;
- bool is_old_packet = false;
- /* packet is within our receive window send ack */
- if (seqnum_in_window(seqnum, channel->readNextIncomingSeqNum(),MAX_RELIABLE_WINDOW_SIZE))
- {
- m_connection->sendAck(peer_id,channelnum,seqnum);
- }
- else {
- is_future_packet = seqnum_higher(seqnum, channel->readNextIncomingSeqNum());
- is_old_packet = seqnum_higher(channel->readNextIncomingSeqNum(), seqnum);
- /* packet is not within receive window, don't send ack. *
- * if this was a valid packet it's gonna be retransmitted */
- if (is_future_packet)
- {
- throw ProcessedSilentlyException("Received packet newer then expected, not sending ack");
- }
- /* seems like our ack was lost, send another one for a old packet */
- if (is_old_packet)
- {
- LOG(dout_con<<m_connection->getDesc()
- << "RE-SENDING ACK: peer_id: " << peer_id
- << ", channel: " << (channelnum&0xFF)
- << ", seqnum: " << seqnum << std::endl;)
- m_connection->sendAck(peer_id,channelnum,seqnum);
- // we already have this packet so this one was on wire at least
- // the current timeout
- // we don't know how long this packet was on wire don't do silly guessing
- // dynamic_cast<UDPPeer*>(&peer)->reportRTT(dynamic_cast<UDPPeer*>(&peer)->getResendTimeout());
- throw ProcessedSilentlyException("Retransmitting ack for old packet");
- }
- }
- if (seqnum != channel->readNextIncomingSeqNum())
- {
- Address peer_address;
- // this is a reliable packet so we have a udp address for sure
- peer->getAddress(MTP_MINETEST_RELIABLE_UDP, peer_address);
- // This one comes later, buffer it.
- // Actually we have to make a packet to buffer one.
- // Well, we have all the ingredients, so just do it.
- BufferedPacket packet = con::makePacket(
- peer_address,
- packetdata,
- m_connection->GetProtocolID(),
- peer_id,
- channelnum);
- try{
- channel->incoming_reliables.insert(packet,channel->readNextIncomingSeqNum());
- LOG(dout_con<<m_connection->getDesc()
- << "BUFFERING, TYPE_RELIABLE peer_id: " << peer_id
- << ", channel: " << (channelnum&0xFF)
- << ", seqnum: " << seqnum << std::endl;)
- throw ProcessedQueued("Buffered future reliable packet");
- }
- catch(AlreadyExistsException &e)
- {
- }
- catch(IncomingDataCorruption &e)
- {
- ConnectionCommand discon;
- discon.disconnect_peer(peer_id);
- m_connection->putCommand(discon);
- LOG(derr_con<<m_connection->getDesc()
- << "INVALID, TYPE_RELIABLE peer_id: " << peer_id
- << ", channel: " << (channelnum&0xFF)
- << ", seqnum: " << seqnum
- << "DROPPING CLIENT!" << std::endl;)
- }
- }
- /* we got a packet to process right now */
- LOG(dout_con<<m_connection->getDesc()
- << "RECURSIVE, TYPE_RELIABLE peer_id: " << peer_id
- << ", channel: " << (channelnum&0xFF)
- << ", seqnum: " << seqnum << std::endl;)
- /* check for resend case */
- u16 queued_seqnum = 0;
- if (channel->incoming_reliables.getFirstSeqnum(queued_seqnum))
- {
- if (queued_seqnum == seqnum)
- {
- BufferedPacket queued_packet = channel->incoming_reliables.popFirst();
- /** TODO find a way to verify the new against the old packet */
- }
- }
- channel->incNextIncomingSeqNum();
- // Get out the inside packet and re-process it
- SharedBuffer<u8> payload(packetdata.getSize() - RELIABLE_HEADER_SIZE);
- memcpy(*payload, &packetdata[RELIABLE_HEADER_SIZE], payload.getSize());
- return processPacket(channel, payload, peer_id, channelnum, true);
- }
- else
- {
- derr_con<<m_connection->getDesc()
- <<"Got invalid type="<<((int)type&0xff)<<std::endl;
- throw InvalidIncomingDataException("Invalid packet type");
- }
- // We should never get here.
- FATAL_ERROR("Invalid execution point");
- }
- /*
- Connection
- */
- Connection::Connection(u32 protocol_id, u32 max_packet_size, float timeout,
- bool ipv6, PeerHandler *peerhandler) :
- m_udpSocket(ipv6),
- m_protocol_id(protocol_id),
- m_sendThread(max_packet_size, timeout),
- m_receiveThread(max_packet_size),
- m_bc_peerhandler(peerhandler)
- {
- m_udpSocket.setTimeoutMs(5);
- m_sendThread.setParent(this);
- m_receiveThread.setParent(this);
- m_sendThread.start();
- m_receiveThread.start();
- }
- Connection::~Connection()
- {
- m_shutting_down = true;
- // request threads to stop
- m_sendThread.stop();
- m_receiveThread.stop();
- //TODO for some unkonwn reason send/receive threads do not exit as they're
- // supposed to be but wait on peer timeout. To speed up shutdown we reduce
- // timeout to half a second.
- m_sendThread.setPeerTimeout(0.5);
- // wait for threads to finish
- m_sendThread.wait();
- m_receiveThread.wait();
- // Delete peers
- for (auto &peer : m_peers) {
- delete peer.second;
- }
- }
- /* Internal stuff */
- void Connection::putEvent(ConnectionEvent &e)
- {
- assert(e.type != CONNEVENT_NONE); // Pre-condition
- m_event_queue.push_back(e);
- }
- PeerHelper Connection::getPeer(u16 peer_id)
- {
- MutexAutoLock peerlock(m_peers_mutex);
- std::map<u16, Peer*>::iterator node = m_peers.find(peer_id);
- if (node == m_peers.end()) {
- throw PeerNotFoundException("GetPeer: Peer not found (possible timeout)");
- }
- // Error checking
- FATAL_ERROR_IF(node->second->id != peer_id, "Invalid peer id");
- return PeerHelper(node->second);
- }
- PeerHelper Connection::getPeerNoEx(u16 peer_id)
- {
- MutexAutoLock peerlock(m_peers_mutex);
- std::map<u16, Peer*>::iterator node = m_peers.find(peer_id);
- if (node == m_peers.end()) {
- return PeerHelper(NULL);
- }
- // Error checking
- FATAL_ERROR_IF(node->second->id != peer_id, "Invalid peer id");
- return PeerHelper(node->second);
- }
- /* find peer_id for address */
- u16 Connection::lookupPeer(Address& sender)
- {
- MutexAutoLock peerlock(m_peers_mutex);
- std::map<u16, Peer*>::iterator j;
- j = m_peers.begin();
- for(; j != m_peers.end(); ++j)
- {
- Peer *peer = j->second;
- if (peer->isPendingDeletion())
- continue;
- Address tocheck;
- if ((peer->getAddress(MTP_MINETEST_RELIABLE_UDP, tocheck)) && (tocheck == sender))
- return peer->id;
- if ((peer->getAddress(MTP_UDP, tocheck)) && (tocheck == sender))
- return peer->id;
- }
- return PEER_ID_INEXISTENT;
- }
- std::list<Peer*> Connection::getPeers()
- {
- std::list<Peer*> list;
- for (auto &p : m_peers) {
- Peer *peer = p.second;
- list.push_back(peer);
- }
- return list;
- }
- bool Connection::deletePeer(u16 peer_id, bool timeout)
- {
- Peer *peer = 0;
- /* lock list as short as possible */
- {
- MutexAutoLock peerlock(m_peers_mutex);
- if (m_peers.find(peer_id) == m_peers.end())
- return false;
- peer = m_peers[peer_id];
- m_peers.erase(peer_id);
- m_peer_ids.remove(peer_id);
- }
- Address peer_address;
- //any peer has a primary address this never fails!
- peer->getAddress(MTP_PRIMARY, peer_address);
- // Create event
- ConnectionEvent e;
- e.peerRemoved(peer_id, timeout, peer_address);
- putEvent(e);
- peer->Drop();
- return true;
- }
- /* Interface */
- ConnectionEvent Connection::waitEvent(u32 timeout_ms)
- {
- try {
- return m_event_queue.pop_front(timeout_ms);
- } catch(ItemNotFoundException &ex) {
- ConnectionEvent e;
- e.type = CONNEVENT_NONE;
- return e;
- }
- }
- void Connection::putCommand(ConnectionCommand &c)
- {
- if (!m_shutting_down) {
- m_command_queue.push_back(c);
- m_sendThread.Trigger();
- }
- }
- void Connection::Serve(Address bind_addr)
- {
- ConnectionCommand c;
- c.serve(bind_addr);
- putCommand(c);
- }
- void Connection::Connect(Address address)
- {
- ConnectionCommand c;
- c.connect(address);
- putCommand(c);
- }
- bool Connection::Connected()
- {
- MutexAutoLock peerlock(m_peers_mutex);
- if (m_peers.size() != 1)
- return false;
- std::map<u16, Peer*>::iterator node = m_peers.find(PEER_ID_SERVER);
- if (node == m_peers.end())
- return false;
- if (m_peer_id == PEER_ID_INEXISTENT)
- return false;
- return true;
- }
- void Connection::Disconnect()
- {
- ConnectionCommand c;
- c.disconnect();
- putCommand(c);
- }
- void Connection::Receive(NetworkPacket* pkt)
- {
- for(;;) {
- ConnectionEvent e = waitEvent(m_bc_receive_timeout);
- if (e.type != CONNEVENT_NONE)
- LOG(dout_con << getDesc() << ": Receive: got event: "
- << e.describe() << std::endl);
- switch(e.type) {
- case CONNEVENT_NONE:
- throw NoIncomingDataException("No incoming data");
- case CONNEVENT_DATA_RECEIVED:
- // Data size is lesser than command size, ignoring packet
- if (e.data.getSize() < 2) {
- continue;
- }
- pkt->putRawPacket(*e.data, e.data.getSize(), e.peer_id);
- return;
- case CONNEVENT_PEER_ADDED: {
- UDPPeer tmp(e.peer_id, e.address, this);
- if (m_bc_peerhandler)
- m_bc_peerhandler->peerAdded(&tmp);
- continue;
- }
- case CONNEVENT_PEER_REMOVED: {
- UDPPeer tmp(e.peer_id, e.address, this);
- if (m_bc_peerhandler)
- m_bc_peerhandler->deletingPeer(&tmp, e.timeout);
- continue;
- }
- case CONNEVENT_BIND_FAILED:
- throw ConnectionBindFailed("Failed to bind socket "
- "(port already in use?)");
- }
- }
- throw NoIncomingDataException("No incoming data");
- }
- void Connection::Send(u16 peer_id, u8 channelnum,
- NetworkPacket* pkt, bool reliable)
- {
- assert(channelnum < CHANNEL_COUNT); // Pre-condition
- ConnectionCommand c;
- c.send(peer_id, channelnum, pkt, reliable);
- putCommand(c);
- }
- Address Connection::GetPeerAddress(u16 peer_id)
- {
- PeerHelper peer = getPeerNoEx(peer_id);
- if (!peer)
- throw PeerNotFoundException("No address for peer found!");
- Address peer_address;
- peer->getAddress(MTP_PRIMARY, peer_address);
- return peer_address;
- }
- float Connection::getPeerStat(u16 peer_id, rtt_stat_type type)
- {
- PeerHelper peer = getPeerNoEx(peer_id);
- if (!peer) return -1;
- return peer->getStat(type);
- }
- float Connection::getLocalStat(rate_stat_type type)
- {
- PeerHelper peer = getPeerNoEx(PEER_ID_SERVER);
- FATAL_ERROR_IF(!peer, "Connection::getLocalStat we couldn't get our own peer? are you serious???");
- float retval = 0.0;
- for (Channel &channel : dynamic_cast<UDPPeer *>(&peer)->channels) {
- switch(type) {
- case CUR_DL_RATE:
- retval += channel.getCurrentDownloadRateKB();
- break;
- case AVG_DL_RATE:
- retval += channel.getAvgDownloadRateKB();
- break;
- case CUR_INC_RATE:
- retval += channel.getCurrentIncomingRateKB();
- break;
- case AVG_INC_RATE:
- retval += channel.getAvgIncomingRateKB();
- break;
- case AVG_LOSS_RATE:
- retval += channel.getAvgLossRateKB();
- break;
- case CUR_LOSS_RATE:
- retval += channel.getCurrentLossRateKB();
- break;
- default:
- FATAL_ERROR("Connection::getLocalStat Invalid stat type");
- }
- }
- return retval;
- }
- u16 Connection::createPeer(Address& sender, MTProtocols protocol, int fd)
- {
- // Somebody wants to make a new connection
- // Get a unique peer id (2 or higher)
- u16 peer_id_new = m_next_remote_peer_id;
- u16 overflow = MAX_UDP_PEERS;
- /*
- Find an unused peer id
- */
- MutexAutoLock lock(m_peers_mutex);
- bool out_of_ids = false;
- for(;;) {
- // Check if exists
- if (m_peers.find(peer_id_new) == m_peers.end())
- break;
- // Check for overflow
- if (peer_id_new == overflow) {
- out_of_ids = true;
- break;
- }
- peer_id_new++;
- }
- if (out_of_ids) {
- errorstream << getDesc() << " ran out of peer ids" << std::endl;
- return PEER_ID_INEXISTENT;
- }
- // Create a peer
- Peer *peer = 0;
- peer = new UDPPeer(peer_id_new, sender, this);
- m_peers[peer->id] = peer;
- m_peer_ids.push_back(peer->id);
- m_next_remote_peer_id = (peer_id_new +1 ) % MAX_UDP_PEERS;
- LOG(dout_con << getDesc()
- << "createPeer(): giving peer_id=" << peer_id_new << std::endl);
- ConnectionCommand cmd;
- SharedBuffer<u8> reply(4);
- writeU8(&reply[0], TYPE_CONTROL);
- writeU8(&reply[1], CONTROLTYPE_SET_PEER_ID);
- writeU16(&reply[2], peer_id_new);
- cmd.createPeer(peer_id_new,reply);
- putCommand(cmd);
- // Create peer addition event
- ConnectionEvent e;
- e.peerAdded(peer_id_new, sender);
- putEvent(e);
- // We're now talking to a valid peer_id
- return peer_id_new;
- }
- void Connection::PrintInfo(std::ostream &out)
- {
- m_info_mutex.lock();
- out<<getDesc()<<": ";
- m_info_mutex.unlock();
- }
- void Connection::PrintInfo()
- {
- PrintInfo(dout_con);
- }
- const std::string Connection::getDesc()
- {
- return std::string("con(")+
- itos(m_udpSocket.GetHandle())+"/"+itos(m_peer_id)+")";
- }
- void Connection::DisconnectPeer(u16 peer_id)
- {
- ConnectionCommand discon;
- discon.disconnect_peer(peer_id);
- putCommand(discon);
- }
- void Connection::sendAck(u16 peer_id, u8 channelnum, u16 seqnum)
- {
- assert(channelnum < CHANNEL_COUNT); // Pre-condition
- LOG(dout_con<<getDesc()
- <<" Queuing ACK command to peer_id: " << peer_id <<
- " channel: " << (channelnum & 0xFF) <<
- " seqnum: " << seqnum << std::endl);
- ConnectionCommand c;
- SharedBuffer<u8> ack(4);
- writeU8(&ack[0], TYPE_CONTROL);
- writeU8(&ack[1], CONTROLTYPE_ACK);
- writeU16(&ack[2], seqnum);
- c.ack(peer_id, channelnum, ack);
- putCommand(c);
- m_sendThread.Trigger();
- }
- UDPPeer* Connection::createServerPeer(Address& address)
- {
- if (getPeerNoEx(PEER_ID_SERVER) != 0)
- {
- throw ConnectionException("Already connected to a server");
- }
- UDPPeer *peer = new UDPPeer(PEER_ID_SERVER, address, this);
- {
- MutexAutoLock lock(m_peers_mutex);
- m_peers[peer->id] = peer;
- m_peer_ids.push_back(peer->id);
- }
- return peer;
- }
- } // namespace
|