0

ナビゲーションオドメトリがありますが、ロボット本体のフレームにはありません。オドメトリはワールド フレームで公開されているため、正確ではありません。そのため、正しい方法でロボット本体フレームに変換する必要があります。そこで、ロボット本体フレームの x 軸の線速度を再公開しようとしましたが、Im が正しい方法であることを確認するためだけに、コードが機能していません。これがROSノードです

#include <ros/ros.h>
#include <tf/transform_broadcaster.h>
#include <nav_msgs/Odometry.h>

float linear_x;
ros::Publisher odom_pub;

void poseCallback(const nav_msgs::OdometryConstPtr& msg){

    linear_x = (msg->twist.twist.linear.x );
    nav_msgs::Odometry pose_gt_frame;

        pose_gt_frame.header.frame_id = "world";

    //set the velocity
    pose_gt_frame.child_frame_id = "rexrov2/base_link";
    pose_gt_frame.twist.twist.linear.x = linear_x;

    //publish the message
    odom_pub.publish(pose_gt_frame);

}

int main(int argc, char** argv){
  ros::init(argc, argv, "my_tf_broadcaster");

  ros::NodeHandle node;
  ros::Subscriber sub = node.subscribe("/rexrov2/pose_gt", 10, &poseCallback);
  ros::spin();
  return 0;
};

コードを実行するとエラーが発生しました

[FATAL] [1635340917.678039503, 15.652000000]: ASSERTION FAILED
    file = /opt/ros/melodic/include/ros/publisher.h
    line = 106
    cond = false
    message = 
[FATAL] [1635340917.680256176, 15.654000000]: Call to publish() on an invalid Publisher
[FATAL] [1635340917.680299807, 15.654000000]:

また、起動ファイルの静的フレームも役に立ちませんでした。何が間違っている可能性がありますか?何か助けはありますか?ありがとう

4

1 に答える 1