MockPositionSensor.cpp

/*
** Copyright (C) 2025 CERN
**
** This software is provided 'as-is', without any express or implied
** warranty.  In no event will the authors be held liable for any damages
** arising from the use of this software.
**
** Permission is granted to anyone to use this software for any purpose,
** including commercial applications, and to alter it and redistribute it
** freely, subject to the following restrictions:
**
** 1. The origin of this software must not be misrepresented; you must not
**    claim that you wrote the original software. If you use this software
**    in a product, an acknowledgment in the product documentation would be
**    appreciated but is not required.
** 2. Altered source versions must be plainly marked as such, and must not be
**    misrepresented as being the original software.
** 3. This notice may not be removed or altered from any source distribution.
**
** Created on: 2025-04-16T13:38:08
** Author: Sylvain Fargier <sylvain.fargier@cern.ch>
*/
 
#include "MockPositionSensor.hpp"
 
#include <ccut/async.hpp>
 
#include "MockPlatform.hpp"
#include "device/PositionSensor.hpp"
 
using namespace logger;
using namespace smc;
using namespace smc::internal;
 
MockPositionSensor::MockPositionSensor(
    const std::string &uid,
    const std::shared_ptr<MockPlatform> &mock) :
    PositionSensor{uid},
    m_mock(mock)
{}
 
std::future<units::value_t> MockPositionSensor::getPosition(
 
    units::unit_t unit) const
{
    std::shared_ptr<MockPlatform> mock(m_mock.lock());
    if (!mock)
        return ccut::make_future_error<units::value_t>(
            Exception(ErrorCode::Canceled, "platform stopped (deleted)"));
 
    info(MockPlatform::s_loggerCat)
        << "Querying POSITION " << uid()
        << " on MockPlatform id: " << mock->getPlatformId() << " for position";
    std::promise<units::value_t> positionPromise;
    auto positionFuture = positionPromise.get_future();
    try
    {
        units::Value lvdtPosition{units::unit_t::MILLIMETERS,
                                  mock->getLvdtAngle(uid())};
        if (!convert(lvdtPosition, unit))
            throw Exception(ErrorCode::IncompatibleUnits);
 
        positionPromise.set_value(lvdtPosition);
    }
    catch (...)
    {
        positionPromise.set_exception(std::current_exception());
    }
    return positionFuture;
}
 
std::future<void> MockPositionSensor::setActualPosition(
    const units::value_t &value) const
{
    std::shared_ptr<MockPlatform> mock(m_mock.lock());
    if (!mock)
        return ccut::make_future_error(
            Exception(ErrorCode::Canceled, "platform stopped (deleted)"));
 
    info(MockPlatform::s_loggerCat)
        << "Set POSITION " << uid()
        << " on MockPlatform id: " << mock->getPlatformId();
    std::promise<void> prom;
    try
    {
        units::value_t lvdtPosition{value};
        if (!convert(lvdtPosition, units::MILLIMETERS))
            throw Exception(ErrorCode::IncompatibleUnits);
 
        mock->setLvdtAngle(uid(), lvdtPosition.value);
        prom.set_value();
    }
    catch (...)
    {
        prom.set_exception(std::current_exception());
    }
    return prom.get_future();
}
 
units::value_t MockPositionSensor::lastPosition(units::unit_t unit) const
{
    std::shared_ptr<MockPlatform> mock(m_mock.lock());
    if (!mock)
        throw Exception(ErrorCode::Canceled, "platform stopped (deleted)");
 
    info(MockPlatform::s_loggerCat)
        << "Get last POSITION " << uid()
        << " on MockPlatform id: " << mock->getPlatformId();
 
    units::value_t ret{units::unit_t::MILLIMETERS, mock->getLvdtAngle(uid())};
 
    if (!convert(ret, unit))
        throw Exception(ErrorCode::IncompatibleUnits);
 
    return ret;
}