keyframe_manager.cpp

Go to the documentation of this file.

#include "keyframe_management/keyframe_manager.h"
 
#include <iostream>
 
namespace KeyframeManagement
{
 
    void
    KeyframeManager::AddKeyframe(int agentId, float timeStamp, float x, float y,
                                 float z)
    {
        Core::CartesianCoordinate position = { x, y, z };
        Core::Keyframe newKeyframe = { agentId, timeStamp, position };
        AddKeyframe(newKeyframe);
    }
 
    void
    KeyframeManager::AddKeyframe(int agentId, float timeStamp,
                                 Core::CartesianCoordinate position)
    {
        Core::Keyframe newKeyframe = { agentId, timeStamp, position };
        AddKeyframe(newKeyframe);
    }
 
    // This function iterate over each keyframe in the m_Keyframes vector and
    // check if the timestamp and agent ID of the keyframe match the provided
    // keyframe. If a match is found, update the position of the existing
    // keyframe
    void
    KeyframeManager::AddKeyframe(Core::Keyframe& keyframe)
    {
        bool exists = false;
        for (Core::Keyframe& kf : m_Keyframes) {
            if (keyframe.TimeStamp == kf.TimeStamp &&
                keyframe.AgentId == kf.AgentId) {
                kf.Position = keyframe.Position;
                exists = true;
            }
        }
        // If no existing keyframe with the same timestamp and agent ID is
        // found, add the new keyframe
        if (!exists) {
            m_Keyframes.push_back(keyframe);
        }
 
        emit KeyframeAdded();
    }
 
    void
    KeyframeManager::RemoveKeyframe(const Core::Keyframe& keyframe)
    {
        for (auto it = m_Keyframes.begin(); it != m_Keyframes.end(); ++it) {
            if (it->AgentId == keyframe.AgentId &&
                it->TimeStamp == keyframe.TimeStamp &&
                it->Position.X == keyframe.Position.X &&
                it->Position.Y == keyframe.Position.Y &&
                it->Position.Z == keyframe.Position.Z) {
                m_Keyframes.erase(it);
                break;
            }
        }
    }
 
    void
    KeyframeManager::DebugDump(void) const
    {
        std::cout << "DebugDump called. Number of keyframes: "
                  << m_Keyframes.size() << std::endl;
        std::cout << "Keyframes:" << std::endl;
        for (const Core::Keyframe& kf : m_Keyframes) {
            std::cout << "AgentId: " << kf.AgentId
                      << " TimeStamp: " << kf.TimeStamp
                      << " X: " << kf.Position.X << " Y: " << kf.Position.Y
                      << " Z: " << kf.Position.Z << std::endl;
        }
    }
 
} // namespace KeyframeManagement