ROS中创建tf的两种方法对比

第一种方法:来源于 http://wiki.ros.org/urdf/Tutorials/Using urdf with robot_state_publisher
cpp源码如下:(相比较于官方的源码,删去了sensor_msgs::JointState部分,只考虑tf的创建与发布)

int main(int argc, char** argv) {
    ros::init(argc, argv, "state_publisher");
    ros::NodeHandle n;
    tf::TransformBroadcaster broadcaster;

    const double degree = M_PI/120;
    double angle = 0;

    // message declarations
/*    This expresses a transform from coordinate frame header.frame_id 
                               to the coordinate frame child_frame_id*/
    geometry_msgs::TransformStamped odom_trans;
    odom_trans.header.frame_id = "odom";
    odom_trans.child_frame_id  = "box";

    ros::Rate loop_rate(30);
    while (ros::ok()) {
        // update transform
        // (moving in a circle with radius=2)
        odom_trans.header.stamp = ros::Time::now();
        odom_trans.transform.translation.x = cos(angle)*2;  //公转半径
        odom_trans.transform.translation.y = sin(angle)*2;  //公转半径
        odom_trans.transform.translation.z = 0;
        odom_trans.transform.rotation = tf::createQuaternionMsgFromYaw(angle+M_PI/2);

        //send the joint state and transform
        broadcaster.sendTransform(odom_trans);

     
  • 1
    点赞
  • 5
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值