code: public Coordinate getPosition() {
  		if (Double.isNaN(this.z)) return new Coordinate(this.getX(), this.getY());
  		return new Coordinate(this.getX(), this.getY(), this.getZ());
  	}
docs: Get the position of this {@link Pose}.
  @return The position of this pose.