|
|
@ -4,6 +4,7 @@ |
|
|
|
#include "Destination.h" |
|
|
|
#include "Destination.h" |
|
|
|
#include "ClientContext.h" |
|
|
|
#include "ClientContext.h" |
|
|
|
#include "I2PEndian.h" |
|
|
|
#include "I2PEndian.h" |
|
|
|
|
|
|
|
#include <cstring> |
|
|
|
#include <cassert> |
|
|
|
#include <cassert> |
|
|
|
|
|
|
|
|
|
|
|
namespace i2p |
|
|
|
namespace i2p |
|
|
@ -22,215 +23,192 @@ namespace proxy |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void SOCKSHandler::Done() { |
|
|
|
|
|
|
|
if (m_parent) m_parent->RemoveHandler (shared_from_this ()); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void SOCKSHandler::Terminate() { |
|
|
|
void SOCKSHandler::Terminate() { |
|
|
|
CloseStream(); |
|
|
|
if (dead.exchange(true)) return; |
|
|
|
CloseSock(); |
|
|
|
if (m_sock) { |
|
|
|
delete this; // HACK: ew
|
|
|
|
LogPrint(eLogDebug,"--- SOCKS close sock"); |
|
|
|
|
|
|
|
m_sock->close(); |
|
|
|
|
|
|
|
delete m_sock; |
|
|
|
|
|
|
|
m_sock = nullptr; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
if (m_stream) { |
|
|
|
|
|
|
|
LogPrint(eLogDebug,"--- SOCKS close stream"); |
|
|
|
|
|
|
|
m_stream.reset (); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
Done(); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void SOCKSHandler::Socks5AuthNegoFailed() |
|
|
|
boost::asio::const_buffers_1 SOCKSHandler::GenerateSOCKS4Response(SOCKSHandler::errTypes error, uint32_t ip, uint16_t port) |
|
|
|
{ |
|
|
|
{ |
|
|
|
LogPrint(eLogWarning,"--- SOCKS5 authentication negotiation failed"); |
|
|
|
assert(error >= SOCKS4_OK); |
|
|
|
boost::asio::async_write(*m_sock, boost::asio::buffer("\x05\xff",2), |
|
|
|
m_response[0] = '\x00'; //Version
|
|
|
|
std::bind(&SOCKSHandler::SentSocksFailed, this, |
|
|
|
m_response[1] = error; //Response code
|
|
|
|
std::placeholders::_1)); |
|
|
|
htobe16buf(m_response+2,port); //Port
|
|
|
|
|
|
|
|
htobe32buf(m_response+4,ip); //IP
|
|
|
|
|
|
|
|
return boost::asio::const_buffers_1(m_response,8); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void SOCKSHandler::Socks5ChooseAuth() |
|
|
|
boost::asio::const_buffers_1 SOCKSHandler::GenerateSOCKS5Response(SOCKSHandler::errTypes error, SOCKSHandler::addrTypes type, |
|
|
|
|
|
|
|
const SOCKSHandler::address &addr, uint16_t port) |
|
|
|
{ |
|
|
|
{ |
|
|
|
LogPrint(eLogDebug,"--- SOCKS5 choosing authentication method"); |
|
|
|
size_t size; |
|
|
|
//TODO: Choose right method
|
|
|
|
assert(error <= SOCKS5_ADDR_UNSUP); |
|
|
|
boost::asio::async_write(*m_sock, boost::asio::buffer("\x05\x00",2), |
|
|
|
m_response[0] = '\x05'; //Version
|
|
|
|
std::bind(&SOCKSHandler::SentSocksResponse, this, |
|
|
|
m_response[1] = error; //Response code
|
|
|
|
std::placeholders::_1, nullptr)); |
|
|
|
m_response[2] = '\x00'; //RSV
|
|
|
|
|
|
|
|
m_response[3] = type; //Address type
|
|
|
|
|
|
|
|
switch (type) { |
|
|
|
|
|
|
|
case ADDR_IPV4: |
|
|
|
|
|
|
|
size = 10; |
|
|
|
|
|
|
|
htobe32buf(m_response+4,addr.ip); |
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
case ADDR_IPV6: |
|
|
|
|
|
|
|
size = 22; |
|
|
|
|
|
|
|
memcpy(m_response+4,addr.ipv6, 16); |
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
case ADDR_DNS: |
|
|
|
|
|
|
|
size = 7+addr.dns.size; |
|
|
|
|
|
|
|
m_response[4] = addr.dns.size; |
|
|
|
|
|
|
|
memcpy(m_response+5,addr.dns.value, addr.dns.size); |
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
htobe16buf(m_response+size-2,port); //Port
|
|
|
|
|
|
|
|
return boost::asio::const_buffers_1(m_response,size); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
static const char *socks5Replies[9] = { |
|
|
|
bool SOCKSHandler::Socks5ChooseAuth() |
|
|
|
"\x05\x00\x00\x01\x00\x00\x00\x00\x00\x00", |
|
|
|
{ |
|
|
|
"\x05\x01\x00\x01\x00\x00\x00\x00\x00\x00", |
|
|
|
m_response[0] = '\x05'; //Version
|
|
|
|
"\x05\x02\x00\x01\x00\x00\x00\x00\x00\x00", |
|
|
|
m_response[1] = m_authchosen; //Response code
|
|
|
|
"\x05\x03\x00\x01\x00\x00\x00\x00\x00\x00", |
|
|
|
boost::asio::const_buffers_1 response(m_response,2); |
|
|
|
"\x05\x04\x00\x01\x00\x00\x00\x00\x00\x00", |
|
|
|
if (m_authchosen == AUTH_UNACCEPTABLE) { |
|
|
|
"\x05\x05\x00\x01\x00\x00\x00\x00\x00\x00", |
|
|
|
LogPrint(eLogWarning,"--- SOCKS5 authentication negotiation failed"); |
|
|
|
"\x05\x06\x00\x01\x00\x00\x00\x00\x00\x00", |
|
|
|
boost::asio::async_write(*m_sock, response, std::bind(&SOCKSHandler::SentSocksFailed, this, std::placeholders::_1)); |
|
|
|
"\x05\x07\x00\x01\x00\x00\x00\x00\x00\x00", |
|
|
|
return false; |
|
|
|
"\x05\x08\x00\x01\x00\x00\x00\x00\x00\x00" }; |
|
|
|
} else { |
|
|
|
|
|
|
|
LogPrint(eLogDebug,"--- SOCKS5 choosing authentication method: ", m_authchosen); |
|
|
|
|
|
|
|
boost::asio::async_write(*m_sock, response, std::bind(&SOCKSHandler::SentSocksResponse, this, std::placeholders::_1)); |
|
|
|
|
|
|
|
return true; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
/* All hope is lost */ |
|
|
|
/* All hope is lost beyond this point */ |
|
|
|
void SOCKSHandler::SocksRequestFailed() |
|
|
|
void SOCKSHandler::SocksRequestFailed(SOCKSHandler::errTypes error) |
|
|
|
{ |
|
|
|
{ |
|
|
|
|
|
|
|
boost::asio::const_buffers_1 response(nullptr,0); |
|
|
|
|
|
|
|
assert(error != SOCKS4_OK && error != SOCKS5_OK); |
|
|
|
switch (m_socksv) { |
|
|
|
switch (m_socksv) { |
|
|
|
case SOCKS4: |
|
|
|
case SOCKS4: |
|
|
|
LogPrint(eLogWarning,"--- SOCKS4 failed"); |
|
|
|
LogPrint(eLogWarning,"--- SOCKS4 failed: ", error); |
|
|
|
//TODO: send the right response
|
|
|
|
if (error < SOCKS4_OK) error = SOCKS4_FAIL; //Transparently map SOCKS5 errors
|
|
|
|
boost::asio::async_write(*m_sock, boost::asio::buffer("\x00\x5b\x00\x00\x00\x00\x00\x00",8), |
|
|
|
response = GenerateSOCKS4Response(error, m_4aip, m_port); |
|
|
|
std::bind(&SOCKSHandler::SentSocksFailed, this, std::placeholders::_1)); |
|
|
|
|
|
|
|
break; |
|
|
|
break; |
|
|
|
case SOCKS5: |
|
|
|
case SOCKS5: |
|
|
|
assert(m_error <= SOCKS5_ADDR_UNSUP); |
|
|
|
LogPrint(eLogWarning,"--- SOCKS5 failed: ", error); |
|
|
|
LogPrint(eLogWarning,"--- SOCKS5 failed"); |
|
|
|
response = GenerateSOCKS5Response(error, m_addrtype, m_address, m_port); |
|
|
|
//TODO: use error properly and address type m_error
|
|
|
|
|
|
|
|
boost::asio::async_write(*m_sock, boost::asio::buffer(socks5Replies[m_error],10), |
|
|
|
|
|
|
|
std::bind(&SOCKSHandler::SentSocksFailed, this, std::placeholders::_1)); |
|
|
|
|
|
|
|
break; |
|
|
|
break; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
boost::asio::async_write(*m_sock, response, std::bind(&SOCKSHandler::SentSocksFailed, this, std::placeholders::_1)); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void SOCKSHandler::SocksRequestSuccess() |
|
|
|
void SOCKSHandler::SocksRequestSuccess() |
|
|
|
{ |
|
|
|
{ |
|
|
|
std::shared_ptr<std::vector<uint8_t>> response(new std::vector<uint8_t>); |
|
|
|
boost::asio::const_buffers_1 response(nullptr,0); |
|
|
|
|
|
|
|
//TODO: this should depend on things like the command type and callbacks may change
|
|
|
|
switch (m_socksv) { |
|
|
|
switch (m_socksv) { |
|
|
|
case SOCKS4: |
|
|
|
case SOCKS4: |
|
|
|
LogPrint(eLogInfo,"--- SOCKS4 connection success"); |
|
|
|
LogPrint(eLogInfo,"--- SOCKS4 connection success"); |
|
|
|
//TODO: send the right response
|
|
|
|
response = GenerateSOCKS4Response(SOCKS4_OK, m_4aip, m_port); |
|
|
|
boost::asio::async_write(*m_sock, boost::asio::buffer("\x00\x5a\x00\x00\x00\x00\x00\x00",8), |
|
|
|
|
|
|
|
std::bind(&SOCKSHandler::SentSocksResponse, this, |
|
|
|
|
|
|
|
std::placeholders::_1, nullptr)); |
|
|
|
|
|
|
|
break; |
|
|
|
break; |
|
|
|
case SOCKS5: |
|
|
|
case SOCKS5: |
|
|
|
LogPrint(eLogInfo,"--- SOCKS5 connection success"); |
|
|
|
LogPrint(eLogInfo,"--- SOCKS5 connection success"); |
|
|
|
//TODO: send the right response using the port? and the localside i2p address
|
|
|
|
auto s = i2p::client::context.GetAddressBook().ToAddress(m_parent->GetLocalDestination()->GetIdentHash()); |
|
|
|
boost::asio::async_write(*m_sock, boost::asio::buffer("\x05\x00\x00\x01\x00\x00\x00\x00\x00\x00",10), |
|
|
|
address ad; ad.dns.FromString(s); |
|
|
|
std::bind(&SOCKSHandler::SentSocksResponse, this, |
|
|
|
//HACK only 16 bits passed in port as SOCKS5 doesn't allow for more
|
|
|
|
std::placeholders::_1, response)); |
|
|
|
response = GenerateSOCKS5Response(SOCKS5_OK, ADDR_DNS, ad, m_stream->GetRecvStreamID()); |
|
|
|
break; |
|
|
|
break; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
boost::asio::async_write(*m_sock, response, std::bind(&SOCKSHandler::SentSocksDone, this, std::placeholders::_1)); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void SOCKSHandler::EnterState(SOCKSHandler::state nstate, uint8_t parseleft) { |
|
|
|
void SOCKSHandler::CloseSock() |
|
|
|
switch (nstate) { |
|
|
|
{ |
|
|
|
case GET_PORT: parseleft = 2; break; |
|
|
|
if (m_sock) { |
|
|
|
case GET_IPV4: m_addrtype = ADDR_IPV4; m_address.ip = 0; parseleft = 4; break; |
|
|
|
LogPrint(eLogDebug,"--- SOCKS close sock"); |
|
|
|
case GET4_IDENT: m_4aip = m_address.ip; break; |
|
|
|
m_sock->close(); |
|
|
|
case GET4A_HOST: |
|
|
|
delete m_sock; |
|
|
|
case GET5_HOST: m_addrtype = ADDR_DNS; m_address.dns.size = 0; break; |
|
|
|
m_sock = nullptr; |
|
|
|
case GET5_IPV6: m_addrtype = ADDR_IPV6; parseleft = 16; break; |
|
|
|
} |
|
|
|
default:; |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void SOCKSHandler::CloseStream() |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
if (m_stream) { |
|
|
|
|
|
|
|
LogPrint(eLogDebug,"--- SOCKS close stream"); |
|
|
|
|
|
|
|
m_stream.reset (); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
std::size_t SOCKSHandler::HandleData(uint8_t *sock_buff, std::size_t len) |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
assert(len); // This should always be called with a least a byte left to parse
|
|
|
|
|
|
|
|
switch (m_state) { |
|
|
|
|
|
|
|
case GET_VERSION: |
|
|
|
|
|
|
|
return HandleVersion(sock_buff); |
|
|
|
|
|
|
|
case SOCKS5_AUTHNEGO: |
|
|
|
|
|
|
|
return HandleSOCKS5AuthNego(sock_buff,len); |
|
|
|
|
|
|
|
case SOCKS_REQUEST: |
|
|
|
|
|
|
|
return HandleSOCKSRequest(sock_buff,len); |
|
|
|
|
|
|
|
default: |
|
|
|
|
|
|
|
LogPrint(eLogError,"--- SOCKS state?? ", m_state); |
|
|
|
|
|
|
|
Terminate(); |
|
|
|
|
|
|
|
return 0; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
std::size_t SOCKSHandler::HandleVersion(uint8_t *sock_buff) |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
switch (*sock_buff) { |
|
|
|
|
|
|
|
case SOCKS4: |
|
|
|
|
|
|
|
m_state = SOCKS_REQUEST; // Switch to the 4 handler
|
|
|
|
|
|
|
|
m_pstate = GET_COMMAND; //Initialize the parser at the right position
|
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
case SOCKS5: |
|
|
|
|
|
|
|
m_state = SOCKS5_AUTHNEGO; // Switch to the 5 handler
|
|
|
|
|
|
|
|
m_pstate = GET5_AUTHNUM; //Initialize the parser at the right position
|
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
default: |
|
|
|
|
|
|
|
LogPrint(eLogError,"--- SOCKS rejected invalid version: ", ((int)*sock_buff)); |
|
|
|
|
|
|
|
Terminate(); |
|
|
|
|
|
|
|
return 0; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
m_socksv = (SOCKSHandler::socksVersions) *sock_buff; |
|
|
|
|
|
|
|
return 1; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
std::size_t SOCKSHandler::HandleSOCKS5AuthNego(uint8_t *sock_buff, std::size_t len) |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
std::size_t rv = 0; |
|
|
|
|
|
|
|
while (len > 0) { |
|
|
|
|
|
|
|
rv++; |
|
|
|
|
|
|
|
switch (m_pstate) |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
case GET5_AUTHNUM: |
|
|
|
|
|
|
|
m_authleft = *sock_buff; |
|
|
|
|
|
|
|
m_pstate = GET5_AUTH; |
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
case GET5_AUTH: |
|
|
|
|
|
|
|
m_authleft --; |
|
|
|
|
|
|
|
if (*sock_buff == AUTH_NONE) |
|
|
|
|
|
|
|
m_authchosen = AUTH_NONE; |
|
|
|
|
|
|
|
if ( m_authleft == 0 ) { |
|
|
|
|
|
|
|
if (m_authchosen == AUTH_UNACCEPTABLE) { |
|
|
|
|
|
|
|
//TODO: we maybe want support for other methods!
|
|
|
|
|
|
|
|
LogPrint(eLogError,"--- SOCKS5 couldn't negotiate authentication"); |
|
|
|
|
|
|
|
Socks5AuthNegoFailed(); |
|
|
|
|
|
|
|
return 0; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
m_pstate = GET5_REQUESTV; |
|
|
|
|
|
|
|
m_state = SOCKS_REQUEST; |
|
|
|
|
|
|
|
m_need_more = false; |
|
|
|
|
|
|
|
Socks5ChooseAuth(); |
|
|
|
|
|
|
|
return rv; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
default: |
|
|
|
|
|
|
|
LogPrint(eLogError,"--- SOCKS5 parse state?? ", m_pstate); |
|
|
|
|
|
|
|
Terminate(); |
|
|
|
|
|
|
|
return 0; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
sock_buff++; |
|
|
|
|
|
|
|
len--; |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
return rv; |
|
|
|
m_parseleft = parseleft; |
|
|
|
|
|
|
|
m_state = nstate; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
bool SOCKSHandler::ValidateSOCKSRequest() { |
|
|
|
void SOCKSHandler::ValidateSOCKSRequest() { |
|
|
|
if ( m_cmd != CMD_CONNECT ) { |
|
|
|
if ( m_cmd != CMD_CONNECT ) { |
|
|
|
//TODO: we need to support binds and other shit!
|
|
|
|
//TODO: we need to support binds and other shit!
|
|
|
|
LogPrint(eLogError,"--- SOCKS unsupported command: ", m_cmd); |
|
|
|
LogPrint(eLogError,"--- SOCKS unsupported command: ", m_cmd); |
|
|
|
m_error = SOCKS5_CMD_UNSUP; |
|
|
|
SocksRequestFailed(SOCKS5_CMD_UNSUP); |
|
|
|
SocksRequestFailed(); |
|
|
|
return; |
|
|
|
return false; |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
//TODO: we may want to support other address types!
|
|
|
|
//TODO: we may want to support other address types!
|
|
|
|
if ( m_addrtype != ADDR_DNS ) { |
|
|
|
if ( m_addrtype != ADDR_DNS ) { |
|
|
|
switch (m_socksv) { |
|
|
|
switch (m_socksv) { |
|
|
|
case SOCKS5: |
|
|
|
case SOCKS5: |
|
|
|
LogPrint(eLogError,"--- SOCKS5 unsupported address type: ", m_addrtype); |
|
|
|
LogPrint(eLogError,"--- SOCKS5 unsupported address type: ", m_addrtype); |
|
|
|
m_error = SOCKS5_ADDR_UNSUP; |
|
|
|
|
|
|
|
break; |
|
|
|
break; |
|
|
|
case SOCKS4: |
|
|
|
case SOCKS4: |
|
|
|
LogPrint(eLogError,"--- SOCKS4a rejected because it's actually SOCKS4"); |
|
|
|
LogPrint(eLogError,"--- SOCKS4a rejected because it's actually SOCKS4"); |
|
|
|
break; |
|
|
|
break; |
|
|
|
} |
|
|
|
} |
|
|
|
SocksRequestFailed(); |
|
|
|
SocksRequestFailed(SOCKS5_ADDR_UNSUP); |
|
|
|
return false; |
|
|
|
return; |
|
|
|
} |
|
|
|
} |
|
|
|
//TODO: we may want to support other domains
|
|
|
|
//TODO: we may want to support other domains
|
|
|
|
if(m_addrtype == ADDR_DNS && m_destination.find(".i2p") == std::string::npos) { |
|
|
|
if(m_addrtype == ADDR_DNS && m_address.dns.ToString().find(".i2p") == std::string::npos) { |
|
|
|
LogPrint(eLogError,"--- SOCKS invalid hostname: ", m_destination); |
|
|
|
LogPrint(eLogError,"--- SOCKS invalid hostname: ", m_address.dns.ToString()); |
|
|
|
m_error = SOCKS5_ADDR_UNSUP; |
|
|
|
SocksRequestFailed(SOCKS5_ADDR_UNSUP); |
|
|
|
SocksRequestFailed(); |
|
|
|
return; |
|
|
|
return false; |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
return true; |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
std::size_t SOCKSHandler::HandleSOCKSRequest(uint8_t *sock_buff, std::size_t len) |
|
|
|
|
|
|
|
|
|
|
|
bool SOCKSHandler::HandleData(uint8_t *sock_buff, std::size_t len) |
|
|
|
{ |
|
|
|
{ |
|
|
|
std::size_t rv = 0; |
|
|
|
assert(len); // This should always be called with a least a byte left to parse
|
|
|
|
while (len > 0) { |
|
|
|
while (len > 0) { |
|
|
|
rv++; |
|
|
|
switch (m_state) { |
|
|
|
switch (m_pstate) |
|
|
|
case GET_SOCKSV: |
|
|
|
{ |
|
|
|
m_socksv = (SOCKSHandler::socksVersions) *sock_buff; |
|
|
|
|
|
|
|
switch (*sock_buff) { |
|
|
|
|
|
|
|
case SOCKS4: |
|
|
|
|
|
|
|
EnterState(GET_COMMAND); //Initialize the parser at the right position
|
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
case SOCKS5: |
|
|
|
|
|
|
|
EnterState(GET5_AUTHNUM); //Initialize the parser at the right position
|
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
default: |
|
|
|
|
|
|
|
LogPrint(eLogError,"--- SOCKS rejected invalid version: ", ((int)*sock_buff)); |
|
|
|
|
|
|
|
Terminate(); |
|
|
|
|
|
|
|
return false; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
case GET5_AUTHNUM: |
|
|
|
|
|
|
|
EnterState(GET5_AUTH, *sock_buff); |
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
case GET5_AUTH: |
|
|
|
|
|
|
|
m_parseleft --; |
|
|
|
|
|
|
|
if (*sock_buff == AUTH_NONE) |
|
|
|
|
|
|
|
m_authchosen = AUTH_NONE; |
|
|
|
|
|
|
|
if ( m_parseleft == 0 ) { |
|
|
|
|
|
|
|
if (!Socks5ChooseAuth()) return false; |
|
|
|
|
|
|
|
EnterState(GET5_REQUESTV); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
break; |
|
|
|
case GET_COMMAND: |
|
|
|
case GET_COMMAND: |
|
|
|
switch (*sock_buff) { |
|
|
|
switch (*sock_buff) { |
|
|
|
case CMD_CONNECT: |
|
|
|
case CMD_CONNECT: |
|
|
@ -240,124 +218,110 @@ namespace proxy |
|
|
|
if (m_socksv == SOCKS5) break; |
|
|
|
if (m_socksv == SOCKS5) break; |
|
|
|
default: |
|
|
|
default: |
|
|
|
LogPrint(eLogError,"--- SOCKS invalid command: ", ((int)*sock_buff)); |
|
|
|
LogPrint(eLogError,"--- SOCKS invalid command: ", ((int)*sock_buff)); |
|
|
|
m_error = SOCKS5_GEN_FAIL; |
|
|
|
SocksRequestFailed(SOCKS5_GEN_FAIL); |
|
|
|
SocksRequestFailed(); |
|
|
|
return false; |
|
|
|
return 0; |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
m_cmd = (SOCKSHandler::cmdTypes)*sock_buff; |
|
|
|
m_cmd = (SOCKSHandler::cmdTypes)*sock_buff; |
|
|
|
switch (m_socksv) { |
|
|
|
switch (m_socksv) { |
|
|
|
case SOCKS5: m_pstate = GET5_GETRSV; break; |
|
|
|
case SOCKS5: EnterState(GET5_GETRSV); break; |
|
|
|
case SOCKS4: m_pstate = GET_PORT; m_addrleft = 2; break; |
|
|
|
case SOCKS4: EnterState(GET_PORT); break; |
|
|
|
} |
|
|
|
} |
|
|
|
break; |
|
|
|
break; |
|
|
|
case GET_PORT: |
|
|
|
case GET_PORT: |
|
|
|
m_port = (m_port << 8)|((uint16_t)*sock_buff); |
|
|
|
m_port = (m_port << 8)|((uint16_t)*sock_buff); |
|
|
|
m_addrleft--; |
|
|
|
m_parseleft--; |
|
|
|
if (m_addrleft == 0) { |
|
|
|
if (m_parseleft == 0) { |
|
|
|
switch (m_socksv) { |
|
|
|
switch (m_socksv) { |
|
|
|
case SOCKS5: m_pstate = DONE; break; |
|
|
|
case SOCKS5: EnterState(DONE); break; |
|
|
|
case SOCKS4: m_pstate = GET_IPV4; m_addrleft = 4; break; |
|
|
|
case SOCKS4: EnterState(GET_IPV4); break; |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
break; |
|
|
|
break; |
|
|
|
case GET_IPV4: |
|
|
|
case GET_IPV4: |
|
|
|
m_ip = (m_ip << 8)|((uint32_t)*sock_buff); |
|
|
|
m_address.ip = (m_address.ip << 8)|((uint32_t)*sock_buff); |
|
|
|
m_addrleft--; |
|
|
|
m_parseleft--; |
|
|
|
if (m_addrleft == 0) { |
|
|
|
if (m_parseleft == 0) { |
|
|
|
switch (m_socksv) { |
|
|
|
switch (m_socksv) { |
|
|
|
case SOCKS5: m_pstate = GET_PORT; m_addrleft = 2; break; |
|
|
|
case SOCKS5: EnterState(GET_PORT); break; |
|
|
|
case SOCKS4: m_pstate = GET4_IDENT; break; |
|
|
|
case SOCKS4: EnterState(GET4_IDENT); m_4aip = m_address.ip; break; |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
break; |
|
|
|
break; |
|
|
|
case GET4_IDENT: |
|
|
|
case GET4_IDENT: |
|
|
|
if (!*sock_buff) { |
|
|
|
if (!*sock_buff) { |
|
|
|
if( m_ip == 0 || m_ip > 255 ) { |
|
|
|
if( m_4aip == 0 || m_4aip > 255 ) { |
|
|
|
m_addrtype = ADDR_IPV4; |
|
|
|
EnterState(DONE); |
|
|
|
m_pstate = DONE; |
|
|
|
|
|
|
|
} else { |
|
|
|
} else { |
|
|
|
m_addrtype = ADDR_DNS; |
|
|
|
EnterState(GET4A_HOST); |
|
|
|
m_pstate = GET4A_HOST; |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
break; |
|
|
|
break; |
|
|
|
case GET4A_HOST: |
|
|
|
case GET4A_HOST: |
|
|
|
if (!*sock_buff) { |
|
|
|
if (!*sock_buff) { |
|
|
|
m_pstate = DONE; |
|
|
|
EnterState(DONE); |
|
|
|
break; |
|
|
|
break; |
|
|
|
} |
|
|
|
} |
|
|
|
if (m_destination.size() > max_socks_hostname_size) { |
|
|
|
if (m_address.dns.size >= max_socks_hostname_size) { |
|
|
|
LogPrint(eLogError,"--- SOCKS4a destination is too large"); |
|
|
|
LogPrint(eLogError,"--- SOCKS4a destination is too large"); |
|
|
|
SocksRequestFailed(); |
|
|
|
SocksRequestFailed(SOCKS4_FAIL); |
|
|
|
return 0; |
|
|
|
return false; |
|
|
|
} |
|
|
|
} |
|
|
|
m_destination.push_back(*sock_buff); |
|
|
|
m_address.dns.push_back(*sock_buff); |
|
|
|
break; |
|
|
|
break; |
|
|
|
case GET5_REQUESTV: |
|
|
|
case GET5_REQUESTV: |
|
|
|
if (*sock_buff != SOCKS5) { |
|
|
|
if (*sock_buff != SOCKS5) { |
|
|
|
LogPrint(eLogError,"--- SOCKS5 rejected unknown request version: ", ((int)*sock_buff)); |
|
|
|
LogPrint(eLogError,"--- SOCKS5 rejected unknown request version: ", ((int)*sock_buff)); |
|
|
|
m_error = SOCKS5_GEN_FAIL; |
|
|
|
SocksRequestFailed(SOCKS5_GEN_FAIL); |
|
|
|
SocksRequestFailed(); |
|
|
|
return false; |
|
|
|
return 0; |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
m_pstate = GET_COMMAND; |
|
|
|
EnterState(GET_COMMAND); |
|
|
|
break; |
|
|
|
break; |
|
|
|
case GET5_GETRSV: |
|
|
|
case GET5_GETRSV: |
|
|
|
if ( *sock_buff != 0 ) { |
|
|
|
if ( *sock_buff != 0 ) { |
|
|
|
LogPrint(eLogError,"--- SOCKS5 unknown reserved field: ", ((int)*sock_buff)); |
|
|
|
LogPrint(eLogError,"--- SOCKS5 unknown reserved field: ", ((int)*sock_buff)); |
|
|
|
m_error = SOCKS5_GEN_FAIL; |
|
|
|
SocksRequestFailed(SOCKS5_GEN_FAIL); |
|
|
|
SocksRequestFailed(); |
|
|
|
return false; |
|
|
|
return 0; |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
m_pstate = GET5_GETADDRTYPE; |
|
|
|
EnterState(GET5_GETADDRTYPE); |
|
|
|
break; |
|
|
|
break; |
|
|
|
case GET5_GETADDRTYPE: |
|
|
|
case GET5_GETADDRTYPE: |
|
|
|
switch (*sock_buff) { |
|
|
|
switch (*sock_buff) { |
|
|
|
case ADDR_IPV4: m_pstate = GET_IPV4; m_addrleft = 4; break; |
|
|
|
case ADDR_IPV4: EnterState(GET_IPV4); break; |
|
|
|
case ADDR_IPV6: m_pstate = GET5_IPV6; m_addrleft = 16; break; |
|
|
|
case ADDR_IPV6: EnterState(GET5_IPV6); break; |
|
|
|
case ADDR_DNS : m_pstate = GET5_HOST_SIZE; break; |
|
|
|
case ADDR_DNS : EnterState(GET5_HOST_SIZE); break; |
|
|
|
default: |
|
|
|
default: |
|
|
|
LogPrint(eLogError,"--- SOCKS5 unknown address type: ", ((int)*sock_buff)); |
|
|
|
LogPrint(eLogError,"--- SOCKS5 unknown address type: ", ((int)*sock_buff)); |
|
|
|
m_error = SOCKS5_GEN_FAIL; |
|
|
|
SocksRequestFailed(SOCKS5_GEN_FAIL); |
|
|
|
SocksRequestFailed(); |
|
|
|
return false; |
|
|
|
return 0; |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
m_addrtype = (SOCKSHandler::addrTypes)*sock_buff; |
|
|
|
|
|
|
|
break; |
|
|
|
break; |
|
|
|
case GET5_IPV6: |
|
|
|
case GET5_IPV6: |
|
|
|
m_ipv6[16-m_addrleft] = *sock_buff; |
|
|
|
m_address.ipv6[16-m_parseleft] = *sock_buff; |
|
|
|
m_addrleft--; |
|
|
|
m_parseleft--; |
|
|
|
if (m_addrleft == 0) { |
|
|
|
if (m_parseleft == 0) EnterState(GET_PORT); |
|
|
|
m_pstate = GET_PORT; |
|
|
|
|
|
|
|
m_addrleft = 2; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
break; |
|
|
|
break; |
|
|
|
case GET5_HOST_SIZE: |
|
|
|
case GET5_HOST_SIZE: |
|
|
|
m_addrleft = *sock_buff; |
|
|
|
EnterState(GET5_HOST, *sock_buff); |
|
|
|
m_pstate = GET5_HOST; |
|
|
|
|
|
|
|
break; |
|
|
|
break; |
|
|
|
case GET5_HOST: |
|
|
|
case GET5_HOST: |
|
|
|
m_destination.push_back(*sock_buff); |
|
|
|
m_address.dns.push_back(*sock_buff); |
|
|
|
m_addrleft--; |
|
|
|
m_parseleft--; |
|
|
|
if (m_addrleft == 0) { |
|
|
|
if (m_parseleft == 0) EnterState(GET_PORT); |
|
|
|
m_pstate = GET_PORT; |
|
|
|
|
|
|
|
m_addrleft = 2; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
break; |
|
|
|
break; |
|
|
|
default: |
|
|
|
default: |
|
|
|
LogPrint(eLogError,"--- SOCKS parse state?? ", m_pstate); |
|
|
|
LogPrint(eLogError,"--- SOCKS parse state?? ", m_state); |
|
|
|
Terminate(); |
|
|
|
Terminate(); |
|
|
|
return 0; |
|
|
|
return false; |
|
|
|
} |
|
|
|
|
|
|
|
if (m_pstate == DONE) { |
|
|
|
|
|
|
|
m_state = READY; |
|
|
|
|
|
|
|
m_need_more = false; |
|
|
|
|
|
|
|
return (ValidateSOCKSRequest() ? rv : 0); |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
sock_buff++; |
|
|
|
sock_buff++; |
|
|
|
len--; |
|
|
|
len--; |
|
|
|
|
|
|
|
if (len && m_state == DONE) { |
|
|
|
|
|
|
|
LogPrint(eLogError,"--- SOCKS rejected because we can't handle extra data"); |
|
|
|
|
|
|
|
SocksRequestFailed(SOCKS5_GEN_FAIL); |
|
|
|
|
|
|
|
return false; |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
return rv; |
|
|
|
return true; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void SOCKSHandler::HandleSockRecv(const boost::system::error_code & ecode, std::size_t len) |
|
|
|
void SOCKSHandler::HandleSockRecv(const boost::system::error_code & ecode, std::size_t len) |
|
|
@ -369,32 +333,17 @@ namespace proxy |
|
|
|
return; |
|
|
|
return; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
std::size_t pos = 0; |
|
|
|
if (HandleData(m_sock_buff, len)) { |
|
|
|
m_need_more = true; |
|
|
|
if (m_state == DONE) { |
|
|
|
while (pos != len && m_state != READY && m_need_more) { |
|
|
|
LogPrint(eLogInfo,"--- SOCKS requested ", m_address.dns.ToString(), ":" , m_port); |
|
|
|
assert(pos < len); //We are overflowing the buffer otherwise
|
|
|
|
m_parent->GetLocalDestination ()->CreateStream ( |
|
|
|
std::size_t rv = HandleData(m_sock_buff + pos, len - pos); |
|
|
|
std::bind (&SOCKSHandler::HandleStreamRequestComplete, |
|
|
|
if (!rv) return; //Something went wrong die misserably
|
|
|
|
this, std::placeholders::_1), m_address.dns.ToString(), m_port); |
|
|
|
pos += rv; |
|
|
|
} else { |
|
|
|
} |
|
|
|
AsyncSockRead(); |
|
|
|
|
|
|
|
|
|
|
|
assert(!(m_state == READY && m_need_more)); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (m_state == READY) { |
|
|
|
|
|
|
|
LogPrint(eLogInfo,"--- SOCKS requested ", m_destination, ":" , m_port); |
|
|
|
|
|
|
|
if (pos != len) { |
|
|
|
|
|
|
|
LogPrint(eLogError,"--- SOCKS rejected because we can't handle extra data"); |
|
|
|
|
|
|
|
SocksRequestFailed(); |
|
|
|
|
|
|
|
return ; |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
m_parent->GetLocalDestination ()->CreateStream ( |
|
|
|
|
|
|
|
std::bind (&SOCKSHandler::HandleStreamRequestComplete, |
|
|
|
|
|
|
|
this, std::placeholders::_1), m_destination, m_port); |
|
|
|
|
|
|
|
} else if (m_need_more) { |
|
|
|
|
|
|
|
LogPrint (eLogDebug,"--- SOCKS Need more data"); |
|
|
|
|
|
|
|
AsyncSockRead(); |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void SOCKSHandler::SentSocksFailed(const boost::system::error_code & ecode) |
|
|
|
void SOCKSHandler::SentSocksFailed(const boost::system::error_code & ecode) |
|
|
@ -407,22 +356,26 @@ namespace proxy |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void SOCKSHandler::SentSocksResponse(const boost::system::error_code & ecode, std::shared_ptr<std::vector<uint8_t>> response) |
|
|
|
void SOCKSHandler::SentSocksDone(const boost::system::error_code & ecode) |
|
|
|
{ |
|
|
|
{ |
|
|
|
response.reset(); // Information wants to be free, so does memory
|
|
|
|
|
|
|
|
if (!ecode) { |
|
|
|
if (!ecode) { |
|
|
|
if(m_state == READY) { |
|
|
|
if (dead.exchange(true)) return; |
|
|
|
LogPrint (eLogInfo,"--- SOCKS New I2PTunnel connection"); |
|
|
|
LogPrint (eLogInfo,"--- SOCKS New I2PTunnel connection"); |
|
|
|
auto connection = std::make_shared<i2p::client::I2PTunnelConnection>((i2p::client::I2PTunnel *)m_parent, m_sock, m_stream); |
|
|
|
auto connection = std::make_shared<i2p::client::I2PTunnelConnection>((i2p::client::I2PTunnel *)m_parent, m_sock, m_stream); |
|
|
|
m_parent->AddConnection (connection); |
|
|
|
m_parent->AddConnection (connection); |
|
|
|
connection->I2PConnect (); |
|
|
|
connection->I2PConnect (); |
|
|
|
} else { |
|
|
|
Done(); |
|
|
|
LogPrint (eLogDebug,"--- SOCKS Go to next state"); |
|
|
|
|
|
|
|
AsyncSockRead(); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
else |
|
|
|
else |
|
|
|
{ |
|
|
|
{ |
|
|
|
|
|
|
|
LogPrint (eLogError,"--- SOCKS Closing socket after completion reply because: ", ecode.message ()); |
|
|
|
|
|
|
|
Terminate(); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void SOCKSHandler::SentSocksResponse(const boost::system::error_code & ecode) |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
if (ecode) { |
|
|
|
LogPrint (eLogError,"--- SOCKS Closing socket after sending reply because: ", ecode.message ()); |
|
|
|
LogPrint (eLogError,"--- SOCKS Closing socket after sending reply because: ", ecode.message ()); |
|
|
|
Terminate(); |
|
|
|
Terminate(); |
|
|
|
} |
|
|
|
} |
|
|
@ -434,13 +387,11 @@ namespace proxy |
|
|
|
m_stream = stream; |
|
|
|
m_stream = stream; |
|
|
|
SocksRequestSuccess(); |
|
|
|
SocksRequestSuccess(); |
|
|
|
} else { |
|
|
|
} else { |
|
|
|
m_error = SOCKS5_HOST_UNREACH; |
|
|
|
|
|
|
|
LogPrint (eLogError,"--- SOCKS Issue when creating the stream, check the previous warnings for more info."); |
|
|
|
LogPrint (eLogError,"--- SOCKS Issue when creating the stream, check the previous warnings for more info."); |
|
|
|
SocksRequestFailed(); |
|
|
|
SocksRequestFailed(SOCKS5_HOST_UNREACH); |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void SOCKSServer::Start () |
|
|
|
void SOCKSServer::Start () |
|
|
|
{ |
|
|
|
{ |
|
|
|
m_Acceptor.listen (); |
|
|
|
m_Acceptor.listen (); |
|
|
@ -452,6 +403,7 @@ namespace proxy |
|
|
|
m_Acceptor.close(); |
|
|
|
m_Acceptor.close(); |
|
|
|
m_Timer.cancel (); |
|
|
|
m_Timer.cancel (); |
|
|
|
ClearConnections (); |
|
|
|
ClearConnections (); |
|
|
|
|
|
|
|
ClearHandlers(); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void SOCKSServer::Accept () |
|
|
|
void SOCKSServer::Accept () |
|
|
@ -461,12 +413,29 @@ namespace proxy |
|
|
|
std::placeholders::_1, newSocket)); |
|
|
|
std::placeholders::_1, newSocket)); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void SOCKSServer::AddHandler (std::shared_ptr<SOCKSHandler> handler) { |
|
|
|
|
|
|
|
std::unique_lock<std::mutex> l(m_HandlersMutex); |
|
|
|
|
|
|
|
m_Handlers.insert (handler); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void SOCKSServer::RemoveHandler (std::shared_ptr<SOCKSHandler> handler) |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
std::unique_lock<std::mutex> l(m_HandlersMutex); |
|
|
|
|
|
|
|
m_Handlers.erase (handler); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void SOCKSServer::ClearHandlers () |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
std::unique_lock<std::mutex> l(m_HandlersMutex); |
|
|
|
|
|
|
|
m_Handlers.clear (); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void SOCKSServer::HandleAccept (const boost::system::error_code& ecode, boost::asio::ip::tcp::socket * socket) |
|
|
|
void SOCKSServer::HandleAccept (const boost::system::error_code& ecode, boost::asio::ip::tcp::socket * socket) |
|
|
|
{ |
|
|
|
{ |
|
|
|
if (!ecode) |
|
|
|
if (!ecode) |
|
|
|
{ |
|
|
|
{ |
|
|
|
LogPrint(eLogDebug,"--- SOCKS accepted"); |
|
|
|
LogPrint(eLogDebug,"--- SOCKS accepted"); |
|
|
|
new SOCKSHandler(this, socket); |
|
|
|
AddHandler(std::make_shared<SOCKSHandler> (this, socket)); |
|
|
|
Accept(); |
|
|
|
Accept(); |
|
|
|
} |
|
|
|
} |
|
|
|
else |
|
|
|
else |
|
|
|