mirror of
https://github.com/PurpleI2P/i2pd
synced 2024-11-10 08:00:38 +03:00
968 lines
28 KiB
C++
968 lines
28 KiB
C++
#include <string.h>
|
|
#include <stdlib.h>
|
|
#include "I2PEndian.h"
|
|
#include <cryptopp/dh.h>
|
|
#include "base64.h"
|
|
#include "Log.h"
|
|
#include "Timestamp.h"
|
|
#include "CryptoConst.h"
|
|
#include "I2NPProtocol.h"
|
|
#include "RouterContext.h"
|
|
#include "Transports.h"
|
|
#include "NetDb.h"
|
|
#include "NTCPSession.h"
|
|
|
|
using namespace i2p::crypto;
|
|
|
|
namespace i2p
|
|
{
|
|
namespace transport
|
|
{
|
|
NTCPSession::NTCPSession (NTCPServer& server, std::shared_ptr<const i2p::data::RouterInfo> in_RemoteRouter):
|
|
TransportSession (in_RemoteRouter), m_Server (server), m_Socket (m_Server.GetService ()),
|
|
m_TerminationTimer (m_Server.GetService ()), m_IsEstablished (false), m_IsTerminated (false),
|
|
m_ReceiveBufferOffset (0), m_NextMessage (nullptr), m_IsSending (false),
|
|
m_NumSentBytes (0), m_NumReceivedBytes (0)
|
|
{
|
|
m_DHKeysPair = transports.GetNextDHKeysPair ();
|
|
m_Establisher = new Establisher;
|
|
}
|
|
|
|
NTCPSession::~NTCPSession ()
|
|
{
|
|
delete m_Establisher;
|
|
}
|
|
|
|
void NTCPSession::CreateAESKey (uint8_t * pubKey, i2p::crypto::AESKey& key)
|
|
{
|
|
CryptoPP::DH dh (elgp, elgg);
|
|
uint8_t sharedKey[256];
|
|
if (!dh.Agree (sharedKey, m_DHKeysPair->privateKey, pubKey))
|
|
{
|
|
LogPrint (eLogError, "Couldn't create shared key");
|
|
Terminate ();
|
|
return;
|
|
};
|
|
|
|
uint8_t * aesKey = key;
|
|
if (sharedKey[0] & 0x80)
|
|
{
|
|
aesKey[0] = 0;
|
|
memcpy (aesKey + 1, sharedKey, 31);
|
|
}
|
|
else if (sharedKey[0])
|
|
memcpy (aesKey, sharedKey, 32);
|
|
else
|
|
{
|
|
// find first non-zero byte
|
|
uint8_t * nonZero = sharedKey + 1;
|
|
while (!*nonZero)
|
|
{
|
|
nonZero++;
|
|
if (nonZero - sharedKey > 32)
|
|
{
|
|
LogPrint (eLogWarning, "First 32 bytes of shared key is all zeros. Ignored");
|
|
return;
|
|
}
|
|
}
|
|
memcpy (aesKey, nonZero, 32);
|
|
}
|
|
}
|
|
|
|
void NTCPSession::Done ()
|
|
{
|
|
m_Server.GetService ().post (std::bind (&NTCPSession::Terminate, shared_from_this ()));
|
|
}
|
|
|
|
void NTCPSession::Terminate ()
|
|
{
|
|
if (!m_IsTerminated)
|
|
{
|
|
m_IsTerminated = true;
|
|
m_IsEstablished = false;
|
|
m_Socket.close ();
|
|
transports.PeerDisconnected (shared_from_this ());
|
|
m_Server.RemoveNTCPSession (shared_from_this ());
|
|
for (auto it: m_SendQueue)
|
|
DeleteI2NPMessage (it);
|
|
m_SendQueue.clear ();
|
|
if (m_NextMessage)
|
|
{
|
|
i2p::DeleteI2NPMessage (m_NextMessage);
|
|
m_NextMessage = nullptr;
|
|
}
|
|
m_TerminationTimer.cancel ();
|
|
LogPrint (eLogInfo, "NTCP session terminated");
|
|
}
|
|
}
|
|
|
|
void NTCPSession::Connected ()
|
|
{
|
|
m_IsEstablished = true;
|
|
|
|
delete m_Establisher;
|
|
m_Establisher = nullptr;
|
|
|
|
delete m_DHKeysPair;
|
|
m_DHKeysPair = nullptr;
|
|
|
|
SendTimeSyncMessage ();
|
|
PostI2NPMessage (CreateDatabaseStoreMsg ()); // we tell immediately who we are
|
|
|
|
transports.PeerConnected (shared_from_this ());
|
|
}
|
|
|
|
void NTCPSession::ClientLogin ()
|
|
{
|
|
if (!m_DHKeysPair)
|
|
m_DHKeysPair = transports.GetNextDHKeysPair ();
|
|
// send Phase1
|
|
const uint8_t * x = m_DHKeysPair->publicKey;
|
|
memcpy (m_Establisher->phase1.pubKey, x, 256);
|
|
CryptoPP::SHA256().CalculateDigest(m_Establisher->phase1.HXxorHI, x, 256);
|
|
const uint8_t * ident = m_RemoteIdentity.GetIdentHash ();
|
|
for (int i = 0; i < 32; i++)
|
|
m_Establisher->phase1.HXxorHI[i] ^= ident[i];
|
|
|
|
boost::asio::async_write (m_Socket, boost::asio::buffer (&m_Establisher->phase1, sizeof (NTCPPhase1)), boost::asio::transfer_all (),
|
|
std::bind(&NTCPSession::HandlePhase1Sent, shared_from_this (), std::placeholders::_1, std::placeholders::_2));
|
|
ScheduleTermination ();
|
|
}
|
|
|
|
void NTCPSession::ServerLogin ()
|
|
{
|
|
boost::system::error_code ec;
|
|
auto ep = m_Socket.remote_endpoint(ec);
|
|
if (!ec)
|
|
{
|
|
m_ConnectedFrom = ep.address ();
|
|
// receive Phase1
|
|
boost::asio::async_read (m_Socket, boost::asio::buffer(&m_Establisher->phase1, sizeof (NTCPPhase1)), boost::asio::transfer_all (),
|
|
std::bind(&NTCPSession::HandlePhase1Received, shared_from_this (),
|
|
std::placeholders::_1, std::placeholders::_2));
|
|
ScheduleTermination ();
|
|
}
|
|
}
|
|
|
|
void NTCPSession::HandlePhase1Sent (const boost::system::error_code& ecode, std::size_t bytes_transferred)
|
|
{
|
|
if (ecode)
|
|
{
|
|
LogPrint (eLogError, "Couldn't send Phase 1 message: ", ecode.message ());
|
|
if (ecode != boost::asio::error::operation_aborted)
|
|
Terminate ();
|
|
}
|
|
else
|
|
{
|
|
boost::asio::async_read (m_Socket, boost::asio::buffer(&m_Establisher->phase2, sizeof (NTCPPhase2)), boost::asio::transfer_all (),
|
|
std::bind(&NTCPSession::HandlePhase2Received, shared_from_this (),
|
|
std::placeholders::_1, std::placeholders::_2));
|
|
}
|
|
}
|
|
|
|
void NTCPSession::HandlePhase1Received (const boost::system::error_code& ecode, std::size_t bytes_transferred)
|
|
{
|
|
if (ecode)
|
|
{
|
|
LogPrint (eLogError, "Phase 1 read error: ", ecode.message ());
|
|
if (ecode != boost::asio::error::operation_aborted)
|
|
Terminate ();
|
|
}
|
|
else
|
|
{
|
|
// verify ident
|
|
uint8_t digest[32];
|
|
CryptoPP::SHA256().CalculateDigest(digest, m_Establisher->phase1.pubKey, 256);
|
|
const uint8_t * ident = i2p::context.GetRouterInfo ().GetIdentHash ();
|
|
for (int i = 0; i < 32; i++)
|
|
{
|
|
if ((m_Establisher->phase1.HXxorHI[i] ^ ident[i]) != digest[i])
|
|
{
|
|
LogPrint (eLogError, "Wrong ident");
|
|
Terminate ();
|
|
return;
|
|
}
|
|
}
|
|
|
|
SendPhase2 ();
|
|
}
|
|
}
|
|
|
|
void NTCPSession::SendPhase2 ()
|
|
{
|
|
if (!m_DHKeysPair)
|
|
m_DHKeysPair = transports.GetNextDHKeysPair ();
|
|
const uint8_t * y = m_DHKeysPair->publicKey;
|
|
memcpy (m_Establisher->phase2.pubKey, y, 256);
|
|
uint8_t xy[512];
|
|
memcpy (xy, m_Establisher->phase1.pubKey, 256);
|
|
memcpy (xy + 256, y, 256);
|
|
CryptoPP::SHA256().CalculateDigest(m_Establisher->phase2.encrypted.hxy, xy, 512);
|
|
uint32_t tsB = htobe32 (i2p::util::GetSecondsSinceEpoch ());
|
|
m_Establisher->phase2.encrypted.timestamp = tsB;
|
|
// TODO: fill filler
|
|
|
|
i2p::crypto::AESKey aesKey;
|
|
CreateAESKey (m_Establisher->phase1.pubKey, aesKey);
|
|
m_Encryption.SetKey (aesKey);
|
|
m_Encryption.SetIV (y + 240);
|
|
m_Decryption.SetKey (aesKey);
|
|
m_Decryption.SetIV (m_Establisher->phase1.HXxorHI + 16);
|
|
|
|
m_Encryption.Encrypt ((uint8_t *)&m_Establisher->phase2.encrypted, sizeof(m_Establisher->phase2.encrypted), (uint8_t *)&m_Establisher->phase2.encrypted);
|
|
boost::asio::async_write (m_Socket, boost::asio::buffer (&m_Establisher->phase2, sizeof (NTCPPhase2)), boost::asio::transfer_all (),
|
|
std::bind(&NTCPSession::HandlePhase2Sent, shared_from_this (), std::placeholders::_1, std::placeholders::_2, tsB));
|
|
|
|
}
|
|
|
|
void NTCPSession::HandlePhase2Sent (const boost::system::error_code& ecode, std::size_t bytes_transferred, uint32_t tsB)
|
|
{
|
|
if (ecode)
|
|
{
|
|
LogPrint (eLogError, "Couldn't send Phase 2 message: ", ecode.message ());
|
|
if (ecode != boost::asio::error::operation_aborted)
|
|
Terminate ();
|
|
}
|
|
else
|
|
{
|
|
boost::asio::async_read (m_Socket, boost::asio::buffer(m_ReceiveBuffer, NTCP_DEFAULT_PHASE3_SIZE), boost::asio::transfer_all (),
|
|
std::bind(&NTCPSession::HandlePhase3Received, shared_from_this (),
|
|
std::placeholders::_1, std::placeholders::_2, tsB));
|
|
}
|
|
}
|
|
|
|
void NTCPSession::HandlePhase2Received (const boost::system::error_code& ecode, std::size_t bytes_transferred)
|
|
{
|
|
if (ecode)
|
|
{
|
|
LogPrint (eLogError, "Phase 2 read error: ", ecode.message (), ". Wrong ident assumed");
|
|
if (ecode != boost::asio::error::operation_aborted)
|
|
{
|
|
// this RI is not valid
|
|
i2p::data::netdb.SetUnreachable (GetRemoteIdentity ().GetIdentHash (), true);
|
|
transports.ReuseDHKeysPair (m_DHKeysPair);
|
|
m_DHKeysPair = nullptr;
|
|
Terminate ();
|
|
}
|
|
}
|
|
else
|
|
{
|
|
i2p::crypto::AESKey aesKey;
|
|
CreateAESKey (m_Establisher->phase2.pubKey, aesKey);
|
|
m_Decryption.SetKey (aesKey);
|
|
m_Decryption.SetIV (m_Establisher->phase2.pubKey + 240);
|
|
m_Encryption.SetKey (aesKey);
|
|
m_Encryption.SetIV (m_Establisher->phase1.HXxorHI + 16);
|
|
|
|
m_Decryption.Decrypt((uint8_t *)&m_Establisher->phase2.encrypted, sizeof(m_Establisher->phase2.encrypted), (uint8_t *)&m_Establisher->phase2.encrypted);
|
|
// verify
|
|
uint8_t xy[512];
|
|
memcpy (xy, m_DHKeysPair->publicKey, 256);
|
|
memcpy (xy + 256, m_Establisher->phase2.pubKey, 256);
|
|
if (!CryptoPP::SHA256().VerifyDigest(m_Establisher->phase2.encrypted.hxy, xy, 512))
|
|
{
|
|
LogPrint (eLogError, "Incorrect hash");
|
|
transports.ReuseDHKeysPair (m_DHKeysPair);
|
|
m_DHKeysPair = nullptr;
|
|
Terminate ();
|
|
return ;
|
|
}
|
|
SendPhase3 ();
|
|
}
|
|
}
|
|
|
|
void NTCPSession::SendPhase3 ()
|
|
{
|
|
auto keys = i2p::context.GetPrivateKeys ();
|
|
uint8_t * buf = m_ReceiveBuffer;
|
|
htobe16buf (buf, keys.GetPublic ().GetFullLen ());
|
|
buf += 2;
|
|
buf += i2p::context.GetIdentity ().ToBuffer (buf, NTCP_BUFFER_SIZE);
|
|
uint32_t tsA = htobe32 (i2p::util::GetSecondsSinceEpoch ());
|
|
htobuf32(buf,tsA);
|
|
buf += 4;
|
|
size_t signatureLen = keys.GetPublic ().GetSignatureLen ();
|
|
size_t len = (buf - m_ReceiveBuffer) + signatureLen;
|
|
size_t paddingSize = len & 0x0F; // %16
|
|
if (paddingSize > 0)
|
|
{
|
|
paddingSize = 16 - paddingSize;
|
|
// TODO: fill padding with random data
|
|
buf += paddingSize;
|
|
len += paddingSize;
|
|
}
|
|
|
|
SignedData s;
|
|
s.Insert (m_Establisher->phase1.pubKey, 256); // x
|
|
s.Insert (m_Establisher->phase2.pubKey, 256); // y
|
|
s.Insert (m_RemoteIdentity.GetIdentHash (), 32); // ident
|
|
s.Insert (tsA); // tsA
|
|
s.Insert (m_Establisher->phase2.encrypted.timestamp); // tsB
|
|
s.Sign (keys, buf);
|
|
|
|
m_Encryption.Encrypt(m_ReceiveBuffer, len, m_ReceiveBuffer);
|
|
boost::asio::async_write (m_Socket, boost::asio::buffer (m_ReceiveBuffer, len), boost::asio::transfer_all (),
|
|
std::bind(&NTCPSession::HandlePhase3Sent, shared_from_this (), std::placeholders::_1, std::placeholders::_2, tsA));
|
|
}
|
|
|
|
void NTCPSession::HandlePhase3Sent (const boost::system::error_code& ecode, std::size_t bytes_transferred, uint32_t tsA)
|
|
{
|
|
if (ecode)
|
|
{
|
|
LogPrint (eLogError, "Couldn't send Phase 3 message: ", ecode.message ());
|
|
if (ecode != boost::asio::error::operation_aborted)
|
|
Terminate ();
|
|
}
|
|
else
|
|
{
|
|
// wait for phase4
|
|
auto signatureLen = m_RemoteIdentity.GetSignatureLen ();
|
|
size_t paddingSize = signatureLen & 0x0F; // %16
|
|
if (paddingSize > 0) signatureLen += (16 - paddingSize);
|
|
boost::asio::async_read (m_Socket, boost::asio::buffer(m_ReceiveBuffer, signatureLen), boost::asio::transfer_all (),
|
|
std::bind(&NTCPSession::HandlePhase4Received, shared_from_this (),
|
|
std::placeholders::_1, std::placeholders::_2, tsA));
|
|
}
|
|
}
|
|
|
|
void NTCPSession::HandlePhase3Received (const boost::system::error_code& ecode, std::size_t bytes_transferred, uint32_t tsB)
|
|
{
|
|
if (ecode)
|
|
{
|
|
LogPrint (eLogError, "Phase 3 read error: ", ecode.message ());
|
|
if (ecode != boost::asio::error::operation_aborted)
|
|
Terminate ();
|
|
}
|
|
else
|
|
{
|
|
m_Decryption.Decrypt (m_ReceiveBuffer, bytes_transferred, m_ReceiveBuffer);
|
|
uint8_t * buf = m_ReceiveBuffer;
|
|
uint16_t size = bufbe16toh (buf);
|
|
m_RemoteIdentity.FromBuffer (buf + 2, size);
|
|
if (m_Server.FindNTCPSession (m_RemoteIdentity.GetIdentHash ()))
|
|
{
|
|
LogPrint (eLogError, "NTCP session already exists");
|
|
Terminate ();
|
|
}
|
|
size_t expectedSize = size + 2/*size*/ + 4/*timestamp*/ + m_RemoteIdentity.GetSignatureLen ();
|
|
size_t paddingLen = expectedSize & 0x0F;
|
|
if (paddingLen) paddingLen = (16 - paddingLen);
|
|
if (expectedSize > NTCP_DEFAULT_PHASE3_SIZE)
|
|
{
|
|
// we need more bytes for Phase3
|
|
expectedSize += paddingLen;
|
|
boost::asio::async_read (m_Socket, boost::asio::buffer(m_ReceiveBuffer + NTCP_DEFAULT_PHASE3_SIZE, expectedSize), boost::asio::transfer_all (),
|
|
std::bind(&NTCPSession::HandlePhase3ExtraReceived, shared_from_this (),
|
|
std::placeholders::_1, std::placeholders::_2, tsB, paddingLen));
|
|
}
|
|
else
|
|
HandlePhase3 (tsB, paddingLen);
|
|
}
|
|
}
|
|
|
|
void NTCPSession::HandlePhase3ExtraReceived (const boost::system::error_code& ecode, std::size_t bytes_transferred, uint32_t tsB, size_t paddingLen)
|
|
{
|
|
if (ecode)
|
|
{
|
|
LogPrint (eLogError, "Phase 3 extra read error: ", ecode.message ());
|
|
if (ecode != boost::asio::error::operation_aborted)
|
|
Terminate ();
|
|
}
|
|
else
|
|
{
|
|
m_Decryption.Decrypt (m_ReceiveBuffer + NTCP_DEFAULT_PHASE3_SIZE, bytes_transferred, m_ReceiveBuffer+ NTCP_DEFAULT_PHASE3_SIZE);
|
|
HandlePhase3 (tsB, paddingLen);
|
|
}
|
|
}
|
|
|
|
void NTCPSession::HandlePhase3 (uint32_t tsB, size_t paddingLen)
|
|
{
|
|
uint8_t * buf = m_ReceiveBuffer + m_RemoteIdentity.GetFullLen () + 2 /*size*/;
|
|
uint32_t tsA = buf32toh(buf);
|
|
buf += 4;
|
|
buf += paddingLen;
|
|
|
|
SignedData s;
|
|
s.Insert (m_Establisher->phase1.pubKey, 256); // x
|
|
s.Insert (m_Establisher->phase2.pubKey, 256); // y
|
|
s.Insert (i2p::context.GetRouterInfo ().GetIdentHash (), 32); // ident
|
|
s.Insert (tsA); // tsA
|
|
s.Insert (tsB); // tsB
|
|
if (!s.Verify (m_RemoteIdentity, buf))
|
|
{
|
|
LogPrint (eLogError, "signature verification failed");
|
|
Terminate ();
|
|
return;
|
|
}
|
|
|
|
SendPhase4 (tsA, tsB);
|
|
}
|
|
|
|
void NTCPSession::SendPhase4 (uint32_t tsA, uint32_t tsB)
|
|
{
|
|
SignedData s;
|
|
s.Insert (m_Establisher->phase1.pubKey, 256); // x
|
|
s.Insert (m_Establisher->phase2.pubKey, 256); // y
|
|
s.Insert (m_RemoteIdentity.GetIdentHash (), 32); // ident
|
|
s.Insert (tsA); // tsA
|
|
s.Insert (tsB); // tsB
|
|
auto keys = i2p::context.GetPrivateKeys ();
|
|
auto signatureLen = keys.GetPublic ().GetSignatureLen ();
|
|
s.Sign (keys, m_ReceiveBuffer);
|
|
size_t paddingSize = signatureLen & 0x0F; // %16
|
|
if (paddingSize > 0) signatureLen += (16 - paddingSize);
|
|
m_Encryption.Encrypt (m_ReceiveBuffer, signatureLen, m_ReceiveBuffer);
|
|
|
|
boost::asio::async_write (m_Socket, boost::asio::buffer (m_ReceiveBuffer, signatureLen), boost::asio::transfer_all (),
|
|
std::bind(&NTCPSession::HandlePhase4Sent, shared_from_this (), std::placeholders::_1, std::placeholders::_2));
|
|
}
|
|
|
|
void NTCPSession::HandlePhase4Sent (const boost::system::error_code& ecode, std::size_t bytes_transferred)
|
|
{
|
|
if (ecode)
|
|
{
|
|
LogPrint (eLogWarning, "Couldn't send Phase 4 message: ", ecode.message ());
|
|
if (ecode != boost::asio::error::operation_aborted)
|
|
Terminate ();
|
|
}
|
|
else
|
|
{
|
|
LogPrint (eLogInfo, "NTCP server session from ", m_Socket.remote_endpoint (), " connected");
|
|
m_Server.AddNTCPSession (shared_from_this ());
|
|
|
|
Connected ();
|
|
m_ReceiveBufferOffset = 0;
|
|
m_NextMessage = nullptr;
|
|
Receive ();
|
|
}
|
|
}
|
|
|
|
void NTCPSession::HandlePhase4Received (const boost::system::error_code& ecode, std::size_t bytes_transferred, uint32_t tsA)
|
|
{
|
|
if (ecode)
|
|
{
|
|
LogPrint (eLogError, "Phase 4 read error: ", ecode.message (), ". Check your clock");
|
|
if (ecode != boost::asio::error::operation_aborted)
|
|
{
|
|
// this router doesn't like us
|
|
i2p::data::netdb.SetUnreachable (GetRemoteIdentity ().GetIdentHash (), true);
|
|
Terminate ();
|
|
}
|
|
}
|
|
else
|
|
{
|
|
m_Decryption.Decrypt(m_ReceiveBuffer, bytes_transferred, m_ReceiveBuffer);
|
|
|
|
// verify signature
|
|
SignedData s;
|
|
s.Insert (m_Establisher->phase1.pubKey, 256); // x
|
|
s.Insert (m_Establisher->phase2.pubKey, 256); // y
|
|
s.Insert (i2p::context.GetRouterInfo ().GetIdentHash (), 32); // ident
|
|
s.Insert (tsA); // tsA
|
|
s.Insert (m_Establisher->phase2.encrypted.timestamp); // tsB
|
|
|
|
if (!s.Verify (m_RemoteIdentity, m_ReceiveBuffer))
|
|
{
|
|
LogPrint (eLogError, "signature verification failed");
|
|
Terminate ();
|
|
return;
|
|
}
|
|
LogPrint (eLogInfo, "NTCP session to ", m_Socket.remote_endpoint (), " connected");
|
|
Connected ();
|
|
|
|
m_ReceiveBufferOffset = 0;
|
|
m_NextMessage = nullptr;
|
|
Receive ();
|
|
}
|
|
}
|
|
|
|
void NTCPSession::Receive ()
|
|
{
|
|
m_Socket.async_read_some (boost::asio::buffer(m_ReceiveBuffer + m_ReceiveBufferOffset, NTCP_BUFFER_SIZE - m_ReceiveBufferOffset),
|
|
std::bind(&NTCPSession::HandleReceived, shared_from_this (),
|
|
std::placeholders::_1, std::placeholders::_2));
|
|
}
|
|
|
|
void NTCPSession::HandleReceived (const boost::system::error_code& ecode, std::size_t bytes_transferred)
|
|
{
|
|
if (ecode)
|
|
{
|
|
LogPrint (eLogError, "Read error: ", ecode.message ());
|
|
if (!m_NumReceivedBytes) m_Server.Ban (m_ConnectedFrom);
|
|
//if (ecode != boost::asio::error::operation_aborted)
|
|
Terminate ();
|
|
}
|
|
else
|
|
{
|
|
m_NumReceivedBytes += bytes_transferred;
|
|
m_ReceiveBufferOffset += bytes_transferred;
|
|
|
|
if (m_ReceiveBufferOffset >= 16)
|
|
{
|
|
int numReloads = 0;
|
|
do
|
|
{
|
|
uint8_t * nextBlock = m_ReceiveBuffer;
|
|
while (m_ReceiveBufferOffset >= 16)
|
|
{
|
|
if (!DecryptNextBlock (nextBlock)) // 16 bytes
|
|
{
|
|
Terminate ();
|
|
return;
|
|
}
|
|
nextBlock += 16;
|
|
m_ReceiveBufferOffset -= 16;
|
|
}
|
|
if (m_ReceiveBufferOffset > 0)
|
|
memcpy (m_ReceiveBuffer, nextBlock, m_ReceiveBufferOffset);
|
|
|
|
// try to read more
|
|
if (numReloads < 5)
|
|
{
|
|
size_t moreBytes = m_Socket.available();
|
|
if (moreBytes)
|
|
{
|
|
if (moreBytes > NTCP_BUFFER_SIZE - m_ReceiveBufferOffset)
|
|
moreBytes = NTCP_BUFFER_SIZE - m_ReceiveBufferOffset;
|
|
boost::system::error_code ec;
|
|
moreBytes = m_Socket.read_some (boost::asio::buffer (m_ReceiveBuffer + m_ReceiveBufferOffset, moreBytes));
|
|
if (ec)
|
|
{
|
|
LogPrint (eLogError, "Read more bytes error: ", ec.message ());
|
|
Terminate ();
|
|
return;
|
|
}
|
|
m_NumReceivedBytes += moreBytes;
|
|
m_ReceiveBufferOffset += moreBytes;
|
|
numReloads++;
|
|
}
|
|
}
|
|
}
|
|
while (m_ReceiveBufferOffset >= 16);
|
|
m_Handler.Flush ();
|
|
}
|
|
|
|
ScheduleTermination (); // reset termination timer
|
|
Receive ();
|
|
}
|
|
}
|
|
|
|
bool NTCPSession::DecryptNextBlock (const uint8_t * encrypted) // 16 bytes
|
|
{
|
|
if (!m_NextMessage) // new message, header expected
|
|
{
|
|
m_NextMessage = i2p::NewI2NPMessage ();
|
|
m_NextMessageOffset = 0;
|
|
|
|
m_Decryption.Decrypt (encrypted, m_NextMessage->buf);
|
|
uint16_t dataSize = bufbe16toh (m_NextMessage->buf);
|
|
if (dataSize)
|
|
{
|
|
// new message
|
|
if (dataSize > NTCP_MAX_MESSAGE_SIZE)
|
|
{
|
|
LogPrint (eLogError, "NTCP data size ", dataSize, " exceeds max size");
|
|
i2p::DeleteI2NPMessage (m_NextMessage);
|
|
m_NextMessage = nullptr;
|
|
return false;
|
|
}
|
|
m_NextMessageOffset += 16;
|
|
m_NextMessage->offset = 2; // size field
|
|
m_NextMessage->len = dataSize + 2;
|
|
}
|
|
else
|
|
{
|
|
// timestamp
|
|
LogPrint ("Timestamp");
|
|
i2p::DeleteI2NPMessage (m_NextMessage);
|
|
m_NextMessage = nullptr;
|
|
return true;
|
|
}
|
|
}
|
|
else // message continues
|
|
{
|
|
m_Decryption.Decrypt (encrypted, m_NextMessage->buf + m_NextMessageOffset);
|
|
m_NextMessageOffset += 16;
|
|
}
|
|
|
|
if (m_NextMessageOffset >= m_NextMessage->len + 4) // +checksum
|
|
{
|
|
// we have a complete I2NP message
|
|
m_Handler.PutNextMessage (m_NextMessage);
|
|
m_NextMessage = nullptr;
|
|
}
|
|
return true;
|
|
}
|
|
|
|
void NTCPSession::Send (i2p::I2NPMessage * msg)
|
|
{
|
|
m_IsSending = true;
|
|
boost::asio::async_write (m_Socket, CreateMsgBuffer (msg), boost::asio::transfer_all (),
|
|
std::bind(&NTCPSession::HandleSent, shared_from_this (), std::placeholders::_1, std::placeholders::_2, std::vector<I2NPMessage *>{ msg }));
|
|
}
|
|
|
|
boost::asio::const_buffers_1 NTCPSession::CreateMsgBuffer (I2NPMessage * msg)
|
|
{
|
|
uint8_t * sendBuffer;
|
|
int len;
|
|
|
|
if (msg)
|
|
{
|
|
// regular I2NP
|
|
if (msg->offset < 2)
|
|
{
|
|
LogPrint (eLogError, "Malformed I2NP message");
|
|
i2p::DeleteI2NPMessage (msg);
|
|
}
|
|
sendBuffer = msg->GetBuffer () - 2;
|
|
len = msg->GetLength ();
|
|
htobe16buf (sendBuffer, len);
|
|
}
|
|
else
|
|
{
|
|
// prepare timestamp
|
|
sendBuffer = m_TimeSyncBuffer;
|
|
len = 4;
|
|
htobuf16(sendBuffer, 0);
|
|
htobe32buf (sendBuffer + 2, time (0));
|
|
}
|
|
int rem = (len + 6) & 0x0F; // %16
|
|
int padding = 0;
|
|
if (rem > 0) padding = 16 - rem;
|
|
// TODO: fill padding
|
|
m_Adler.CalculateDigest (sendBuffer + len + 2 + padding, sendBuffer, len + 2+ padding);
|
|
|
|
int l = len + padding + 6;
|
|
m_Encryption.Encrypt(sendBuffer, l, sendBuffer);
|
|
return boost::asio::buffer ((const uint8_t *)sendBuffer, l);
|
|
}
|
|
|
|
|
|
void NTCPSession::Send (const std::vector<I2NPMessage *>& msgs)
|
|
{
|
|
m_IsSending = true;
|
|
std::vector<boost::asio::const_buffer> bufs;
|
|
for (auto it: msgs)
|
|
bufs.push_back (CreateMsgBuffer (it));
|
|
boost::asio::async_write (m_Socket, bufs, boost::asio::transfer_all (),
|
|
std::bind(&NTCPSession::HandleSent, shared_from_this (), std::placeholders::_1, std::placeholders::_2, msgs));
|
|
}
|
|
|
|
void NTCPSession::HandleSent (const boost::system::error_code& ecode, std::size_t bytes_transferred, std::vector<I2NPMessage *> msgs)
|
|
{
|
|
m_IsSending = false;
|
|
for (auto it: msgs)
|
|
if (it) i2p::DeleteI2NPMessage (it);
|
|
if (ecode)
|
|
{
|
|
LogPrint (eLogWarning, "Couldn't send msgs: ", ecode.message ());
|
|
// we shouldn't call Terminate () here, because HandleReceive takes care
|
|
// TODO: 'delete this' statement in Terminate () must be eliminated later
|
|
// Terminate ();
|
|
}
|
|
else
|
|
{
|
|
m_NumSentBytes += bytes_transferred;
|
|
if (!m_SendQueue.empty())
|
|
{
|
|
Send (m_SendQueue);
|
|
m_SendQueue.clear ();
|
|
}
|
|
else
|
|
ScheduleTermination (); // reset termination timer
|
|
}
|
|
}
|
|
|
|
|
|
void NTCPSession::SendTimeSyncMessage ()
|
|
{
|
|
Send (nullptr);
|
|
}
|
|
|
|
void NTCPSession::SendI2NPMessage (I2NPMessage * msg)
|
|
{
|
|
m_Server.GetService ().post (std::bind (&NTCPSession::PostI2NPMessage, shared_from_this (), msg));
|
|
}
|
|
|
|
void NTCPSession::PostI2NPMessage (I2NPMessage * msg)
|
|
{
|
|
if (msg)
|
|
{
|
|
if (m_IsTerminated)
|
|
{
|
|
DeleteI2NPMessage (msg);
|
|
return;
|
|
}
|
|
if (m_IsSending)
|
|
m_SendQueue.push_back (msg);
|
|
else
|
|
Send (msg);
|
|
}
|
|
}
|
|
|
|
void NTCPSession::SendI2NPMessages (const std::vector<I2NPMessage *>& msgs)
|
|
{
|
|
m_Server.GetService ().post (std::bind (&NTCPSession::PostI2NPMessages, shared_from_this (), msgs));
|
|
}
|
|
|
|
void NTCPSession::PostI2NPMessages (std::vector<I2NPMessage *> msgs)
|
|
{
|
|
if (m_IsTerminated)
|
|
{
|
|
for (auto it: msgs)
|
|
DeleteI2NPMessage (it);
|
|
return;
|
|
}
|
|
if (m_IsSending)
|
|
{
|
|
for (auto it: msgs)
|
|
m_SendQueue.push_back (it);
|
|
}
|
|
else
|
|
Send (msgs);
|
|
}
|
|
|
|
void NTCPSession::ScheduleTermination ()
|
|
{
|
|
m_TerminationTimer.cancel ();
|
|
m_TerminationTimer.expires_from_now (boost::posix_time::seconds(NTCP_TERMINATION_TIMEOUT));
|
|
m_TerminationTimer.async_wait (std::bind (&NTCPSession::HandleTerminationTimer,
|
|
shared_from_this (), std::placeholders::_1));
|
|
}
|
|
|
|
void NTCPSession::HandleTerminationTimer (const boost::system::error_code& ecode)
|
|
{
|
|
if (ecode != boost::asio::error::operation_aborted)
|
|
{
|
|
LogPrint ("No activity fo ", NTCP_TERMINATION_TIMEOUT, " seconds");
|
|
//Terminate ();
|
|
m_Socket.close ();// invoke Terminate () from HandleReceive
|
|
}
|
|
}
|
|
|
|
//-----------------------------------------
|
|
NTCPServer::NTCPServer (int port):
|
|
m_IsRunning (false), m_Thread (nullptr), m_Work (m_Service),
|
|
m_NTCPAcceptor (nullptr), m_NTCPV6Acceptor (nullptr)
|
|
{
|
|
}
|
|
|
|
NTCPServer::~NTCPServer ()
|
|
{
|
|
Stop ();
|
|
}
|
|
|
|
void NTCPServer::Start ()
|
|
{
|
|
if (!m_IsRunning)
|
|
{
|
|
m_IsRunning = true;
|
|
m_Thread = new std::thread (std::bind (&NTCPServer::Run, this));
|
|
// create acceptors
|
|
auto addresses = context.GetRouterInfo ().GetAddresses ();
|
|
for (auto& address : addresses)
|
|
{
|
|
if (address.transportStyle == i2p::data::RouterInfo::eTransportNTCP && address.host.is_v4 ())
|
|
{
|
|
m_NTCPAcceptor = new boost::asio::ip::tcp::acceptor (m_Service,
|
|
boost::asio::ip::tcp::endpoint(boost::asio::ip::tcp::v4(), address.port));
|
|
|
|
LogPrint (eLogInfo, "Start listening TCP port ", address.port);
|
|
auto conn = std::make_shared<NTCPSession>(*this);
|
|
m_NTCPAcceptor->async_accept(conn->GetSocket (), std::bind (&NTCPServer::HandleAccept, this,
|
|
conn, std::placeholders::_1));
|
|
|
|
if (context.SupportsV6 ())
|
|
{
|
|
m_NTCPV6Acceptor = new boost::asio::ip::tcp::acceptor (m_Service);
|
|
m_NTCPV6Acceptor->open (boost::asio::ip::tcp::v6());
|
|
m_NTCPV6Acceptor->set_option (boost::asio::ip::v6_only (true));
|
|
m_NTCPV6Acceptor->bind (boost::asio::ip::tcp::endpoint(boost::asio::ip::tcp::v6(), address.port));
|
|
m_NTCPV6Acceptor->listen ();
|
|
|
|
LogPrint (eLogInfo, "Start listening V6 TCP port ", address.port);
|
|
auto conn = std::make_shared<NTCPSession> (*this);
|
|
m_NTCPV6Acceptor->async_accept(conn->GetSocket (), std::bind (&NTCPServer::HandleAcceptV6,
|
|
this, conn, std::placeholders::_1));
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void NTCPServer::Stop ()
|
|
{
|
|
m_NTCPSessions.clear ();
|
|
|
|
if (m_IsRunning)
|
|
{
|
|
m_IsRunning = false;
|
|
delete m_NTCPAcceptor;
|
|
m_NTCPAcceptor = nullptr;
|
|
delete m_NTCPV6Acceptor;
|
|
m_NTCPV6Acceptor = nullptr;
|
|
|
|
m_Service.stop ();
|
|
if (m_Thread)
|
|
{
|
|
m_Thread->join ();
|
|
delete m_Thread;
|
|
m_Thread = nullptr;
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
void NTCPServer::Run ()
|
|
{
|
|
while (m_IsRunning)
|
|
{
|
|
try
|
|
{
|
|
m_Service.run ();
|
|
}
|
|
catch (std::exception& ex)
|
|
{
|
|
LogPrint ("NTCP server: ", ex.what ());
|
|
}
|
|
}
|
|
}
|
|
|
|
void NTCPServer::AddNTCPSession (std::shared_ptr<NTCPSession> session)
|
|
{
|
|
if (session)
|
|
{
|
|
std::unique_lock<std::mutex> l(m_NTCPSessionsMutex);
|
|
m_NTCPSessions[session->GetRemoteIdentity ().GetIdentHash ()] = session;
|
|
}
|
|
}
|
|
|
|
void NTCPServer::RemoveNTCPSession (std::shared_ptr<NTCPSession> session)
|
|
{
|
|
if (session)
|
|
{
|
|
std::unique_lock<std::mutex> l(m_NTCPSessionsMutex);
|
|
m_NTCPSessions.erase (session->GetRemoteIdentity ().GetIdentHash ());
|
|
}
|
|
}
|
|
|
|
std::shared_ptr<NTCPSession> NTCPServer::FindNTCPSession (const i2p::data::IdentHash& ident)
|
|
{
|
|
std::unique_lock<std::mutex> l(m_NTCPSessionsMutex);
|
|
auto it = m_NTCPSessions.find (ident);
|
|
if (it != m_NTCPSessions.end ())
|
|
return it->second;
|
|
return nullptr;
|
|
}
|
|
|
|
void NTCPServer::HandleAccept (std::shared_ptr<NTCPSession> conn, const boost::system::error_code& error)
|
|
{
|
|
if (!error)
|
|
{
|
|
boost::system::error_code ec;
|
|
auto ep = conn->GetSocket ().remote_endpoint(ec);
|
|
if (!ec)
|
|
{
|
|
LogPrint (eLogInfo, "Connected from ", ep);
|
|
auto it = m_BanList.find (ep.address ());
|
|
if (it != m_BanList.end ())
|
|
{
|
|
uint32_t ts = i2p::util::GetSecondsSinceEpoch ();
|
|
if (ts < it->second)
|
|
{
|
|
LogPrint (eLogInfo, ep.address (), " is banned for ", it->second - ts, " more seconds");
|
|
conn = nullptr;
|
|
}
|
|
else
|
|
m_BanList.erase (it);
|
|
}
|
|
if (conn)
|
|
conn->ServerLogin ();
|
|
}
|
|
else
|
|
LogPrint (eLogError, "Connected from error ", ec.message ());
|
|
}
|
|
|
|
|
|
if (error != boost::asio::error::operation_aborted)
|
|
{
|
|
conn = std::make_shared<NTCPSession> (*this);
|
|
m_NTCPAcceptor->async_accept(conn->GetSocket (), std::bind (&NTCPServer::HandleAccept, this,
|
|
conn, std::placeholders::_1));
|
|
}
|
|
}
|
|
|
|
void NTCPServer::HandleAcceptV6 (std::shared_ptr<NTCPSession> conn, const boost::system::error_code& error)
|
|
{
|
|
if (!error)
|
|
{
|
|
boost::system::error_code ec;
|
|
auto ep = conn->GetSocket ().remote_endpoint(ec);
|
|
if (!ec)
|
|
{
|
|
LogPrint (eLogInfo, "Connected from ", ep);
|
|
auto it = m_BanList.find (ep.address ());
|
|
if (it != m_BanList.end ())
|
|
{
|
|
uint32_t ts = i2p::util::GetSecondsSinceEpoch ();
|
|
if (ts < it->second)
|
|
{
|
|
LogPrint (eLogInfo, ep.address (), " is banned for ", it->second - ts, " more seconds");
|
|
conn = nullptr;
|
|
}
|
|
else
|
|
m_BanList.erase (it);
|
|
}
|
|
if (conn)
|
|
conn->ServerLogin ();
|
|
}
|
|
else
|
|
LogPrint (eLogError, "Connected from error ", ec.message ());
|
|
}
|
|
|
|
if (error != boost::asio::error::operation_aborted)
|
|
{
|
|
conn = std::make_shared<NTCPSession> (*this);
|
|
m_NTCPV6Acceptor->async_accept(conn->GetSocket (), std::bind (&NTCPServer::HandleAcceptV6, this,
|
|
conn, std::placeholders::_1));
|
|
}
|
|
}
|
|
|
|
void NTCPServer::Connect (const boost::asio::ip::address& address, int port, std::shared_ptr<NTCPSession> conn)
|
|
{
|
|
LogPrint (eLogInfo, "Connecting to ", address ,":", port);
|
|
m_Service.post([conn, this]()
|
|
{
|
|
this->AddNTCPSession (conn);
|
|
});
|
|
conn->GetSocket ().async_connect (boost::asio::ip::tcp::endpoint (address, port),
|
|
std::bind (&NTCPServer::HandleConnect, this, std::placeholders::_1, conn));
|
|
}
|
|
|
|
void NTCPServer::HandleConnect (const boost::system::error_code& ecode, std::shared_ptr<NTCPSession> conn)
|
|
{
|
|
if (ecode)
|
|
{
|
|
LogPrint (eLogError, "Connect error: ", ecode.message ());
|
|
if (ecode != boost::asio::error::operation_aborted)
|
|
i2p::data::netdb.SetUnreachable (conn->GetRemoteIdentity ().GetIdentHash (), true);
|
|
conn->Terminate ();
|
|
}
|
|
else
|
|
{
|
|
LogPrint (eLogInfo, "Connected to ", conn->GetSocket ().remote_endpoint ());
|
|
if (conn->GetSocket ().local_endpoint ().protocol () == boost::asio::ip::tcp::v6()) // ipv6
|
|
context.UpdateNTCPV6Address (conn->GetSocket ().local_endpoint ().address ());
|
|
conn->ClientLogin ();
|
|
}
|
|
}
|
|
|
|
void NTCPServer::Ban (const boost::asio::ip::address& addr)
|
|
{
|
|
uint32_t ts = i2p::util::GetSecondsSinceEpoch ();
|
|
m_BanList[addr] = ts + NTCP_BAN_EXPIRATION_TIMEOUT;
|
|
LogPrint (eLogInfo, addr, " has been banned for ", NTCP_BAN_EXPIRATION_TIMEOUT, " seconds");
|
|
}
|
|
}
|
|
}
|