Skip to content
Snippets Groups Projects
Commit 1362055f authored by Rainer Kartmann's avatar Rainer Kartmann
Browse files

Remove old files

parent 54cb15be
No related branches found
No related tags found
2 merge requests!140armem/dev -> master,!133Add Object Memory with Class and Instance Segments
#include "objpose.h"
#include <ArmarXCore/core/exceptions/local/UnexpectedEnumValueException.h>
#include <RobotAPI/libraries/ArmarXObjects/aron_conversions.h>
void armarx::objpose::fromAron(const arondto::ObjectAttachmentInfo& dto, ObjectAttachmentInfo& bo)
{
bo.frameName = dto.frameName;
bo.agentName = dto.agentName;
bo.poseInFrame = dto.poseInFrame;
}
void armarx::objpose::toAron(arondto::ObjectAttachmentInfo& dto, const ObjectAttachmentInfo& bo)
{
dto.frameName = bo.frameName;
dto.agentName = bo.agentName;
dto.poseInFrame = bo.poseInFrame;
}
void armarx::objpose::fromAron(const arondto::ObjectType& dto, ObjectTypeEnum& bo)
{
switch (dto.value)
{
case arondto::ObjectType::AnyObject:
bo = ObjectTypeEnum::AnyObject;
return;
case arondto::ObjectType::KnownObject:
bo = ObjectTypeEnum::KnownObject;
return;
case arondto::ObjectType::UnknownObject:
bo = ObjectTypeEnum::UnknownObject;
return;
}
ARMARX_UNEXPECTED_ENUM_VALUE(arondto::ObjectType, dto.value);
}
void armarx::objpose::toAron(arondto::ObjectType& dto, const ObjectTypeEnum& bo)
{
switch (bo)
{
case ObjectTypeEnum::AnyObject:
dto.value = arondto::ObjectType::AnyObject;
return;
case ObjectTypeEnum::KnownObject:
dto.value = arondto::ObjectType::KnownObject;
return;
case ObjectTypeEnum::UnknownObject:
dto.value = arondto::ObjectType::UnknownObject;
return;
}
ARMARX_UNEXPECTED_ENUM_VALUE(ObjectTypeEnum, bo);
}
void armarx::objpose::fromAron(const arondto::ObjectPose& dto, ObjectPose& bo)
{
bo.providerName = dto.providerName;
fromAron(dto.objectType, bo.objectType);
fromAron(dto.objectID, bo.objectID);
bo.objectPoseRobot = dto.objectPoseRobot;
bo.objectPoseGlobal = dto.objectPoseGlobal;
bo.objectPoseOriginal = dto.objectPoseOriginal;
bo.objectPoseOriginalFrame = dto.objectPoseOriginalFrame;
bo.robotConfig = dto.robotConfig;
bo.robotPose = dto.robotPose;
if (dto.attachmentValid)
{
bo.attachment = ObjectAttachmentInfo();
fromAron(dto.attachment, *bo.attachment);
}
else
{
bo.attachment = std::nullopt;
}
bo.confidence = dto.confidence;
bo.timestamp = IceUtil::Time::microSeconds(dto.timestamp);
if (dto.localOOBBValid)
{
bo.localOOBB = simox::OrientedBoxf();
fromAron(dto.localOOBB, *bo.localOOBB);
}
else
{
bo.localOOBB = std::nullopt;
}
}
void armarx::objpose::toAron(arondto::ObjectPose& dto, const ObjectPose& bo)
{
dto.providerName = bo.providerName;
toAron(dto.objectType, bo.objectType);
toAron(dto.objectID, bo.objectID);
dto.objectPoseRobot = bo.objectPoseRobot;
dto.objectPoseGlobal = bo.objectPoseGlobal;
dto.objectPoseOriginal = bo.objectPoseOriginal;
dto.objectPoseOriginalFrame = bo.objectPoseOriginalFrame;
dto.robotConfig = bo.robotConfig;
dto.robotPose = bo.robotPose;
if (bo.attachment)
{
dto.attachmentValid = true;
toAron(dto.attachment, *bo.attachment);
}
else
{
dto.attachmentValid = false;
toAron(dto.attachment, ObjectAttachmentInfo());
}
dto.confidence = bo.confidence;
dto.timestamp = bo.timestamp.toMicroSeconds();
if (bo.localOOBB)
{
dto.localOOBBValid = true;
toAron(dto.localOOBB, *bo.localOOBB);
}
else
{
dto.localOOBBValid = false;
toAron(dto.localOOBB, simox::OrientedBoxf());
}
}
#pragma once
#include <RobotAPI/libraries/ArmarXObjects/ObjectPose.h>
#include <RobotAPI/libraries/ArmarXObjects/aron/ObjectPose.aron.generated.h>
#include <RobotAPI/libraries/ArmarXObjects/aron/ObjectType.aron.generated.h>
namespace armarx::objpose
{
void fromAron(const arondto::ObjectAttachmentInfo& dto, ObjectAttachmentInfo& bo);
void toAron(arondto::ObjectAttachmentInfo& dto, const ObjectAttachmentInfo& bo);
void fromAron(const arondto::ObjectType& dto, ObjectTypeEnum& bo);
void toAron(arondto::ObjectType& dto, const ObjectTypeEnum& bo);
void fromAron(const arondto::ObjectPose& dto, ObjectPose& bo);
void toAron(arondto::ObjectPose& dto, const ObjectPose& bo);
}
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment