geometry_msgs.msg.dds.PoseWithCovarianceStamped Maven / Gradle / Ivy

Go to download
package geometry_msgs.msg.dds;

import us.ihmc.communication.packets.Packet;
import us.ihmc.euclid.interfaces.Settable;
import us.ihmc.euclid.interfaces.EpsilonComparable;
import java.util.function.Supplier;
import us.ihmc.pubsub.TopicDataType;

/**
       * This expresses an estimated pose with a reference coordinate frame and timestamp
       */
public class PoseWithCovarianceStamped extends Packet implements Settable, EpsilonComparable
{
   public std_msgs.msg.dds.Header header_;
   public geometry_msgs.msg.dds.PoseWithCovariance pose_;

   public PoseWithCovarianceStamped()
   {
      header_ = new std_msgs.msg.dds.Header();
      pose_ = new geometry_msgs.msg.dds.PoseWithCovariance();
   }

   public PoseWithCovarianceStamped(PoseWithCovarianceStamped other)
   {
      this();
      set(other);
   }

   public void set(PoseWithCovarianceStamped other)
   {
      std_msgs.msg.dds.HeaderPubSubType.staticCopy(other.header_, header_);
      geometry_msgs.msg.dds.PoseWithCovariancePubSubType.staticCopy(other.pose_, pose_);
   }


   public std_msgs.msg.dds.Header getHeader()
   {
      return header_;
   }


   public geometry_msgs.msg.dds.PoseWithCovariance getPose()
   {
      return pose_;
   }


   public static Supplier getPubSubType()
   {
      return PoseWithCovarianceStampedPubSubType::new;
   }

   @Override
   public Supplier getPubSubTypePacket()
   {
      return PoseWithCovarianceStampedPubSubType::new;
   }

   @Override
   public boolean epsilonEquals(PoseWithCovarianceStamped other, double epsilon)
   {
      if(other == null) return false;
      if(other == this) return true;

      if (!this.header_.epsilonEquals(other.header_, epsilon)) return false;
      if (!this.pose_.epsilonEquals(other.pose_, epsilon)) return false;

      return true;
   }

   @Override
   public boolean equals(Object other)
   {
      if(other == null) return false;
      if(other == this) return true;
      if(!(other instanceof PoseWithCovarianceStamped)) return false;

      PoseWithCovarianceStamped otherMyClass = (PoseWithCovarianceStamped) other;

      if (!this.header_.equals(otherMyClass.header_)) return false;
      if (!this.pose_.equals(otherMyClass.pose_)) return false;

      return true;
   }

   @Override
   public java.lang.String toString()
   {
      StringBuilder builder = new StringBuilder();

      builder.append("PoseWithCovarianceStamped {");
      builder.append("header=");
      builder.append(this.header_);      builder.append(", ");
      builder.append("pose=");
      builder.append(this.pose_);
      builder.append("}");
      return builder.toString();
   }
}