Skip to content
Snippets Groups Projects
Commit d59833b5 authored by Mirko Wächter's avatar Mirko Wächter
Browse files

platformunit observer: initialize odometry datafields on start up

parent 4a67e632
No related branches found
No related tags found
No related merge requests found
...@@ -81,6 +81,9 @@ void PlatformUnitObserver::onConnectObserver() ...@@ -81,6 +81,9 @@ void PlatformUnitObserver::onConnectObserver()
offerDataField("platformOdometryPose", "positionY", VariantType::Float, "Current Odometry Y position of " + platformNodeName + " in mm"); offerDataField("platformOdometryPose", "positionY", VariantType::Float, "Current Odometry Y position of " + platformNodeName + " in mm");
offerDataField("platformOdometryPose", "rotation", VariantType::Float, "Current Odometry Rotation of " + platformNodeName + " in radian"); offerDataField("platformOdometryPose", "rotation", VariantType::Float, "Current Odometry Rotation of " + platformNodeName + " in radian");
// odometry pose is always zero in the beginning - set it so that it can be queried
reportPlatformOdometryPose(0, 0, 0, armarx::GlobalIceCurrent);
} }
void PlatformUnitObserver::reportPlatformPose(::Ice::Float currentPlatformPositionX, ::Ice::Float currentPlatformPositionY, ::Ice::Float currentPlatformRotation, const Ice::Current& c) void PlatformUnitObserver::reportPlatformPose(::Ice::Float currentPlatformPositionX, ::Ice::Float currentPlatformPositionY, ::Ice::Float currentPlatformRotation, const Ice::Current& c)
......
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