ROS小海龟跟随案例:turtle2转圈【错误解决】【python】

总之就是看1.你设置的循环频率是不是太小了;

                  2.atan2()函数的参数是不是传反了

(错的轨迹太离谱,海龟跟疯了一样,用这篇文章记录下哈哈哈,又是粗心惹的祸)

情况1:turtle2能跟到turtle1,但是不是一道平滑的曲线,跟随过程中在转圈圈。

错因:设置的循环频率Rate太小--->改成10就可以了。

rospy.Rate(1) ---> rospy.Rate(10)

情况2:turtle2不能跟随到turtle1,同时还转圈圈。

错因:设置的Rate太小--->改成10;

   rospy.Rate(1) ---> rospy.Rate(10)

           同时,计算角速度的时候参数传反了(atan2(y, x)函数:前一个参数是y,后一个参数是x)--->把参数位置换一下就可以了。

ts = buffer.lookup_transform("turtle2", "turtle1", rospy.Time(0))

# twist = Twist()
# twist.angular.z = 4 * math.atan2(ts.transform.translation.x, ts.transform.translation.y)
# 改成下面

twist = Twist()
twist.angular.z = 4 * math.atan2(ts.transform.translation.y, ts.transform.translation.x)

情况3:turtle2不能跟随到turtle1,乱跑

错因:计算角速度的时候参数传反了(atan2(y, x)函数:前一个参数是y,后一个参数是x)--->把参数位置换一下就可以了。

ts = buffer.lookup_transform("turtle2", "turtle1", rospy.Time(0))

# twist = Twist()
# twist.angular.z = 4 * math.atan2(ts.transform.translation.x, ts.transform.translation.y)
# 改成下面

twist = Twist()
twist.angular.z = 4 * math.atan2(ts.transform.translation.y, ts.transform.translation.x)

运行正常的轨迹

  • 8
    点赞
  • 4
    收藏
    觉得还不错? 一键收藏
  • 1
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值