[Robot] To transition to a succeeded state, the goal must be in a preempting or active state...

记录
错误:To transition to a succeeded state, the goal must be in a preempting or active state, it is currently in state: 2
原因:不能在抢占回调后server端仍然发送setSucceeded(),因为抢占后便放弃了之前的执行,错在此处

            server.setSucceeded();

解决:加入一个bool变量标识符在执行函数中,解决抢断的逻辑问题
执行函数修改如下

	void ExecuteCb(const franka_msgs::PickGoalConstPtr& goal)
    { 
    	action_ = true;//为保证标识符有效且不影响正常运行,应进入执行函数时便设置为true
    	 ...//(此处为代码块省略)
        if(action_){
            server.setSucceeded();
        }
    }

抢断函数修改如下:

    void preemptCb() 
    { 
       //会自动执行第一个目标再执行第二个。;
            ROS_INFO_STREAM("into preemptCB ...");
            action_ = false;//此处告知:我抢断了,就别发succeed了
    	    group_->stop();
    	    server.setPreempted();
	}

实际跑测有效

  • 0
    点赞
  • 2
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值