SqMod/vendor/POCO/Net/src/ICMPSocketImpl.cpp

//
// ICMPSocketImpl.cpp
//
// Library: Net
// Package: ICMP
// Module:  ICMPSocketImpl
//
// Copyright (c) 2006, Applied Informatics Software Engineering GmbH.
// and Contributors.
//
// SPDX-License-Identifier:	BSL-1.0
//


#include "Poco/Net/ICMPSocketImpl.h"
#include "Poco/Net/ICMPv4PacketImpl.h"
#include "Poco/Net/NetException.h"
#include "Poco/Format.h"
#include "Poco/Buffer.h"


using Poco::TimeoutException;
using Poco::Timespan;
using Poco::Exception;


namespace Poco {
namespace Net {


ICMPSocketImpl::ICMPSocketImpl(IPAddress::Family family, int dataSize, int ttl, int timeout):
	RawSocketImpl(family, IPPROTO_ICMP),
	_icmpPacket(family, dataSize),
	_ttl(ttl),
	_timeout(timeout)
{
	setOption(IPPROTO_IP, IP_TTL, ttl);
	setBlocking(true);
	setReceiveTimeout(Timespan(timeout));
}


ICMPSocketImpl::~ICMPSocketImpl()
{
}


int ICMPSocketImpl::sendTo(const void*, int, const SocketAddress& address, int flags)
{
	int n = SocketImpl::sendTo(_icmpPacket.packet(), _icmpPacket.packetSize(), address, flags);
	return n;
}


void ICMPSocketImpl::checkFragmentation(const std::string& err, int type, int code)
{
	if (type == ICMPv4PacketImpl::DESTINATION_UNREACHABLE &&
		code == ICMPv4PacketImpl::FRAGMENTATION_NEEDED_AND_DF_SET)
	{
		throw ICMPFragmentationException(err);
	}
}


int ICMPSocketImpl::receiveFrom(void*, int, SocketAddress& address, int flags)
{
	int maxPacketSize = _icmpPacket.maxPacketSize();
	Poco::Buffer<unsigned char> buffer(maxPacketSize);
	int leftover = _icmpPacket.packetSize();
	int type = 0, code = 0;

	try
	{
		Poco::Timestamp ts;
		int rc;
		do
		{
			// guard against a DoS attack
			if (ts.isElapsed(_timeout)) throw TimeoutException();
			buffer.clear();
			SocketAddress respAddr;
			rc = SocketImpl::receiveFrom(buffer.begin(), maxPacketSize, respAddr, flags);
			if (rc == 0) break;
			if (respAddr == address)
			{
				leftover -= rc;
				if (leftover <= 0)
				{
					if (_icmpPacket.validReplyID(buffer.begin(), maxPacketSize)) break;
					std::string err = _icmpPacket.errorDescription(buffer.begin(), maxPacketSize, type, code);
					if (address.family() == IPAddress::IPv4) checkFragmentation(err, type, code);
					if (!err.empty()) throw ICMPException(err);
					throw ICMPException("Invalid ICMP reply");
				}
			}
			else continue;
		}
		while (leftover > 0 && !_icmpPacket.validReplyID(buffer.begin(), maxPacketSize));
	}
	catch (ICMPException&)
	{
		throw;
	}
	catch (TimeoutException&)
	{
		throw;
	}
	catch (Exception&)
	{
		std::string err = _icmpPacket.errorDescription(buffer.begin(), maxPacketSize, type, code);
		if (address.family() == IPAddress::IPv4) checkFragmentation(err, type, code);
		if (!err.empty()) throw ICMPException(err);
		else throw;
	}

	if (leftover > 0)
	{
		std::string err = leftover < _icmpPacket.packetSize() ? "Incomplete" : "No";
		throw ICMPException(Poco::format("%s response: expected %d, received: %d", err, _icmpPacket.packetSize(),
				_icmpPacket.packetSize() - leftover));
	}

	struct timeval then = _icmpPacket.time(buffer.begin(), maxPacketSize);
	struct timeval now  = _icmpPacket.time();

	int elapsed	= (((now.tv_sec * 1000000) + now.tv_usec) - ((then.tv_sec * 1000000) + then.tv_usec))/1000;

	return elapsed;
}


} } // namespace Poco::Net