SyncTimedRead.h

Go to the documentation of this file.

/*
 * Copyright (C) 2012 by
 *   MetraLabs GmbH (MLAB), GERMANY
 * and
 *   Neuroinformatics and Cognitive Robotics Labs (NICR) at TU Ilmenau, GERMANY
 * All rights reserved.
 *
 * Contact: info@mira-project.org
 *
 * Commercial Usage:
 *   Licensees holding valid commercial licenses may use this file in
 *   accordance with the commercial license agreement provided with the
 *   software or, alternatively, in accordance with the terms contained in
 *   a written agreement between you and MLAB or NICR.
 *
 * GNU General Public License Usage:
 *   Alternatively, this file may be used under the terms of the GNU
 *   General Public License version 3.0 as published by the Free Software
 *   Foundation and appearing in the file LICENSE.GPL3 included in the
 *   packaging of this file. Please review the following information to
 *   ensure the GNU General Public License version 3.0 requirements will be
 *   met: http://www.gnu.org/copyleft/gpl.html.
 *   Alternatively you may (at your option) use any later version of the GNU
 *   General Public License if such license has been publicly approved by
 *   MLAB and NICR (or its successors, if any).
 *
 * IN NO EVENT SHALL "MLAB" OR "NICR" BE LIABLE TO ANY PARTY FOR DIRECT,
 * INDIRECT, SPECIAL, INCIDENTAL, OR CONSEQUENTIAL DAMAGES ARISING OUT OF
 * THE USE OF THIS SOFTWARE AND ITS DOCUMENTATION, EVEN IF "MLAB" OR
 * "NICR" HAS BEEN ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 * "MLAB" AND "NICR" SPECIFICALLY DISCLAIM ANY WARRANTIES, INCLUDING,
 * BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND
 * FITNESS FOR A PARTICULAR PURPOSE. THE SOFTWARE PROVIDED HEREUNDER IS
 * ON AN "AS IS" BASIS, AND "MLAB" AND "NICR" HAVE NO OBLIGATION TO
 * PROVIDE MAINTENANCE, SUPPORT, UPDATES, ENHANCEMENTS OR MODIFICATIONS.
 */

#ifndef _MIRA_SYNCTIMEDREAD_H_
#define _MIRA_SYNCTIMEDREAD_H_

#ifndef Q_MOC_RUN
#include <boost/asio/deadline_timer.hpp>
#include <boost/optional.hpp>
#if BOOST_VERSION >= 106600
#  include <boost/asio/io_context.hpp>
#  include <boost/asio/system_timer.hpp>
#endif
#endif

#include <utils/Bind.h>
#include <utils/Time.h>
#include <error/Exceptions.h>

namespace boost { namespace asio {



namespace Private {

inline void setTimerResult(optional<system::error_code>* codeStorage,
                           system::error_code code)
{
    // If we got a boost::asio::error::operation_aborted, ignore it.
    if (code == error::operation_aborted)
        return;

    codeStorage->reset(code);
}

inline void setResult(optional<system::error_code>* codeStorage,
                      std::size_t* bytesReceivedStorage,
                      system::error_code code, std::size_t bytesReceived)
{
    // If we got a boost::asio::error::operation_aborted, ignore it.
    if (code == error::operation_aborted)
        return;

    codeStorage->reset(code);
    *bytesReceivedStorage = bytesReceived;
}

}


template<typename SyncReadStream, typename MutableBufferSequence>
std::size_t read_some(SyncReadStream& s, const MutableBufferSequence& buffers,
                      mira::Duration timeout)
{
    system::error_code ec;
    std::size_t bytesRead = read_some(s, buffers, timeout, ec);
    detail::throw_error(ec);
    return bytesRead;
}

template<typename SyncReadStream, typename MutableBufferSequence>
std::size_t read_some(SyncReadStream& s, const MutableBufferSequence& buffers,
                      mira::Duration timeout, system::error_code& ec)
{
    ec = boost::system::error_code();
    optional<system::error_code> timerResult;
    optional<system::error_code> readResult;
    std::size_t bytesRead = 0;

#if BOOST_VERSION >= 106600
    boost::asio::io_context& s_io_service = static_cast<boost::asio::io_context&>(s.get_executor().context());
    system_timer timer(s_io_service);
    timer.expires_after(std::chrono::microseconds(timeout.total_microseconds()));
#else
    auto& s_io_service = s.get_io_service();
    deadline_timer timer(s_io_service);
    timer.expires_from_now(timeout);
#endif

#if BOOST_VERSION >= 107400
    using namespace mira::placeholders;
#endif
    timer.async_wait(bind(&Private::setTimerResult, &timerResult, _1));

    s.async_read_some(buffers, bind(&Private::setResult,
                                    &readResult, &bytesRead, _1, _2));

#if BOOST_VERSION < 106600
    s_io_service.reset();
#else
    s_io_service.restart();
#endif

    // For more details on the following code, please look here:
    // http://stackoverflow.com/questions/10858719/cancel-async-read-due-to-timeout

    // It is important to use a loop here, to ensure, that all handlers are
    // remove from the io_service, before leaving this method. Otherwise a
    // subsequent call of read_some will return immediately caused by still
    // outstanding handlers.
    // The io_service::reset() method only allows the io_service to resume
    // running from a stopped state, it does not remove any handlers already
    // queued into the io_service.

    while (s_io_service.run_one())
    {
        if (readResult)
        {
            // Data received, so cancel the timer.
            // This will result in a call of the handler Private::setTimerResult
            // with boost::asio::error::operation_aborted as the error.
            timer.cancel();
            ec = readResult.get();
        } else
        if (timerResult)
        {
            // Timeout occurred, so cancel the read operation. This will result
            // in a call of the handler Private::setResult with the error code
            // boost::asio::error::operation_aborted.
            s.cancel();
            ec = system::error_code(system::errc::timed_out,
                                    system::generic_category());
            //return bytesRead;
        }
    }

    // Reset service, guaranteeing it is in a good state for subsequential runs.
#if BOOST_VERSION < 106600
    s_io_service.reset();
#else
    s_io_service.restart();
#endif

    return bytesRead;
}


}}

#endif