Revision history [back]

I need to filter for a quaternion of zero length.

void OdomToTransform::publishTransformStamped(const ros::TimerEvent& event) {
// odom -> transformStamped (point)
geometry_msgs::TransformStamped transform;
transform.header = odometry_.header;
transform.child_frame_id = odometry_.child_frame_id;
transform.transform.translation.x = odometry_.pose.pose.position.x;
transform.transform.translation.y = odometry_.pose.pose.position.y;
transform.transform.translation.z = odometry_.pose.pose.position.z;
transform.transform.rotation = odometry_.pose.pose.orientation;
    if (transform.transform.rotation.x !=0 && transform.transform.rotation.y!=0 && transform.transform.rotation.z!=0 && transform.transform.rotation.w!=0){
        transform_pub_.publish(transform);
    }
}