}
else
{
- jointTrajPoint.time_from_start.nanosec=1000000000+poseStamped->header.stamp.nanosec-t0_->nanosec;
+ jointTrajPoint.time_from_start.nanosec=1000000000+poseStamped->header.stamp.nanosec-t0_->nanosec;
jointTrajPoint.time_from_start.sec=poseStamped->header.stamp.sec-t0_->sec-1;
}
void Pose2Joint::robotDescriptionCB(const std_msgs::msg::String::SharedPtr robotDescription)
{
- robotDescription_=robotDescription->data;
+ robotDescription_=robotDescription->data;
}
int main(int argc,char* argv[])
Eigen::Matrix<double,6,1> L;
L << 1.0 , 1.0 , 1.0, 0.01, 0.01, 0.01;
for(int i=0;i < argc-3 && i < L.size();i++) L(i)=atof(argv[i+3]);
-
- rclcpp::spin(std::make_shared<Pose2Joint>("pose_stamped2joint",argv[1],argv[2],L));
-
- return 0;
+
+ rclcpp::spin(std::make_shared<Pose2Joint>("pose_stamped2joint",argv[1],argv[2],L));
+
+ return 0;
}