- 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;
- }
- else {
- 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;
- }
- }
- else
- {
- 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;
- }
- else {
- 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;
- }
- }
-
- //never reached
- 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 (std::list<u16>::iterator i = peerids.begin();
- i != peerids.end();
- i++)
- {
- sendAsPacket(*i, 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(std::list<SharedBuffer<u8> >::iterator i = originals.begin();
- i != originals.end(); ++i)
- {
- SharedBuffer<u8> original = *i;
- 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 (std::list<u16>::iterator i = peerids.begin();
- i != peerids.end();
- i++)
- {
- send(*i, channelnum, data);
- }
-}
-
-void ConnectionSendThread::sendToAllReliable(ConnectionCommand &c)
-{
- 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;
-
- 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(std::list<u16>::iterator
- j = peerIds.begin();
- j != peerIds.end(); ++j)
- {
- PeerHelper peer = m_connection->getPeerNoEx(*j);
- //peer may have been removed
- if (!peer) {
- LOG(dout_con<<m_connection->getDesc()<< " Peer not found: peer_id=" << *j << std::endl);
- continue;
- }
- peer->m_increment_packets_remaining = m_iteration_packets_avaialble/m_connection->m_peers.size();
-
- if (dynamic_cast<UDPPeer*>(&peer) == 0)
- {
- continue;
- }
-
- if (dynamic_cast<UDPPeer*>(&peer)->m_pending_disconnect)
- {
- pendingDisconnect.push_back(*j);
- }
-
- PROFILE(std::stringstream peerIdentifier);
- PROFILE(peerIdentifier << "sendPackets[" << m_connection->getDesc() << ";" << *j << ";RELIABLE]");
- PROFILE(ScopeProfiler peerprofiler(g_profiler, peerIdentifier.str(), SPT_AVG));
-
- LOG(dout_con<<m_connection->getDesc()
- << " Handle per peer queues: peer_id=" << *j
- << " 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++)
- {
- u16 next_to_ack = 0;
- dynamic_cast<UDPPeer*>(&peer)->channels[i].outgoing_reliables_sent.getFirstSeqnum(next_to_ack);
- u16 next_to_receive = 0;
- dynamic_cast<UDPPeer*>(&peer)->channels[i].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: "
- << dynamic_cast<UDPPeer*>(&peer)->channels[i].outgoing_reliables_sent.size()
- << ", waiting for ack for " << next_to_ack
- << std::endl
- << "\t\t\tincoming_reliables: "
- << dynamic_cast<UDPPeer*>(&peer)->channels[i].incoming_reliables.size()
- << ", next reliable packet: "
- << dynamic_cast<UDPPeer*>(&peer)->channels[i].readNextIncomingSeqNum()
- << ", next queued: " << next_to_receive
- << std::endl
- << "\t\t\treliables queued : "
- << dynamic_cast<UDPPeer*>(&peer)->channels[i].queued_reliables.size()
- << std::endl
- << "\t\t\tqueued commands : "
- << dynamic_cast<UDPPeer*>(&peer)->channels[i].queued_commands.size()
- << std::endl);
-
- while ((dynamic_cast<UDPPeer*>(&peer)->channels[i].queued_reliables.size() > 0) &&
- (dynamic_cast<UDPPeer*>(&peer)->channels[i].outgoing_reliables_sent.size()
- < dynamic_cast<UDPPeer*>(&peer)->channels[i].getWindowSize())&&
- (peer->m_increment_packets_remaining > 0))
- {
- BufferedPacket p = dynamic_cast<UDPPeer*>(&peer)->channels[i].queued_reliables.front();
- dynamic_cast<UDPPeer*>(&peer)->channels[i].queued_reliables.pop();
- Channel* channel = &(dynamic_cast<UDPPeer*>(&peer)->channels[i]);
- 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.size())
- {
- 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 */
- else 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(std::list<u16>::iterator
- k = pendingDisconnect.begin();
- k != pendingDisconnect.end(); ++k)
- {
- if (!pending_unreliable[*k])
- {
- m_connection->deletePeer(*k,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) :
- m_connection(NULL)
-{
-}
-
-void * ConnectionReceiveThread::Thread()
-{
- assert(m_connection != NULL);
- ThreadStarted();
- log_register_thread("ConnectionReceive");
-
- LOG(dout_con<<m_connection->getDesc()
- <<"ConnectionReceive thread started"<<std::endl);
-
- PROFILE(std::stringstream ThreadIdentifier);
- PROFILE(ThreadIdentifier << "ConnectionReceive: [" << m_connection->getDesc() << "]");
-
- porting::setThreadName("ConnectionReceive");
-
-#ifdef DEBUG_CONNECTION_KBPS
- u32 curtime = porting::getTimeMs();
- u32 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(errorstream);
- }
- 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");
- }
-
- /* preserve original peer_id for later usage */
- u16 packet_peer_id = peer_id;
-
- /* Try to identify peer by sender address (may happen on join) */
- if (peer_id == PEER_ID_INEXISTENT) {
- peer_id = m_connection->lookupPeer(sender);
- }
-
- /* 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;
- }
- }
-
-
- /* mark peer as seen with id */
- if (!(packet_peer_id == PEER_ID_INEXISTENT))
- peer->setSentWithID();
-
- 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(std::list<u16>::iterator j = peerids.begin();
- j != peerids.end(); ++j)
- {
- PeerHelper peer = m_connection->getPeerNoEx(*j);
- if (!peer)
- continue;
-
- if (dynamic_cast<UDPPeer*>(&peer) == 0)
- continue;
-
- for(u16 i=0; i<CHANNEL_COUNT; i++)
- {
- Channel *channel = &(dynamic_cast<UDPPeer*>(&peer))->channels[i];
-
- 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) {
- errorstream << "Something is wrong with peer_id" << std::endl;
- FATAL_ERROR("");
- }
-
- if (type == TYPE_CONTROL)
- {
- if (packetdata.getSize() < 2)
- throw InvalidIncomingDataException("packetdata.getSize() < 2");
-
- u8 controltype = readU8(&(packetdata[1]));
-
- if (controltype == CONTROLTYPE_ACK)
- {
- FATAL_ERROR_IF(channel == 0, "Invalid channel (0)");
- 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
- unsigned int 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) == 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)
- {
- FATAL_ERROR_IF(channel == 0, "Invalid channel (0)");
- // 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) :
- m_udpSocket(ipv6),
- m_command_queue(),
- m_event_queue(),
- m_peer_id(0),
- m_protocol_id(protocol_id),
- m_sendThread(max_packet_size, timeout),
- m_receiveThread(max_packet_size),
- m_info_mutex(),
- m_bc_peerhandler(0),
- m_bc_receive_timeout(0),
- m_shutting_down(false),
- m_next_remote_peer_id(2)
-{
- m_udpSocket.setTimeoutMs(5);
-
- m_sendThread.setParent(this);
- m_receiveThread.setParent(this);
-
- m_sendThread.Start();
- m_receiveThread.Start();
-}
-
-Connection::Connection(u32 protocol_id, u32 max_packet_size, float timeout,
- bool ipv6, PeerHandler *peerhandler) :
- m_udpSocket(ipv6),
- m_command_queue(),
- m_event_queue(),
- m_peer_id(0),
- m_protocol_id(protocol_id),
- m_sendThread(max_packet_size, timeout),
- m_receiveThread(max_packet_size),
- m_info_mutex(),
- m_bc_peerhandler(peerhandler),
- m_bc_receive_timeout(0),
- m_shutting_down(false),
- m_next_remote_peer_id(2)
-
-{
- 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(std::map<u16, Peer*>::iterator
- j = m_peers.begin();
- j != m_peers.end(); ++j)
- {
- delete j->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)
-{
- JMutexAutoLock 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)
-{
- JMutexAutoLock 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)
-{
- JMutexAutoLock 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->isActive())
- 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(std::map<u16, Peer*>::iterator j = m_peers.begin();
- j != m_peers.end(); ++j)
- {
- Peer *peer = j->second;
- list.push_back(peer);
- }
- return list;
-}
-
-bool Connection::deletePeer(u16 peer_id, bool timeout)
-{
- Peer *peer = 0;
-
- /* lock list as short as possible */
- {
- JMutexAutoLock 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::getEvent()
-{
- if (m_event_queue.empty()) {
- ConnectionEvent e;
- e.type = CONNEVENT_NONE;
- return e;
- }
- return m_event_queue.pop_frontNoEx();
-}
-
-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()
-{
- JMutexAutoLock peerlock(m_peers_mutex);