From 750a3c3e0642573d1e61398366702114914f7c14 Mon Sep 17 00:00:00 2001 From: zhangwanjie Date: Wed, 1 Jul 2020 19:43:09 +0800 Subject: [PATCH] update for simulation --- wpb_home_behaviors/src/wpb_home_grab_server.cpp | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/wpb_home_behaviors/src/wpb_home_grab_server.cpp b/wpb_home_behaviors/src/wpb_home_grab_server.cpp index fb80a58..5702bed 100644 --- a/wpb_home_behaviors/src/wpb_home_grab_server.cpp +++ b/wpb_home_behaviors/src/wpb_home_grab_server.cpp @@ -580,7 +580,7 @@ void ProcCloudCB(const sensor_msgs::PointCloud2 &input) } nTimeDelayCounter ++; VelCmd(0,0,0); - if(nTimeDelayCounter > 200) + if(nTimeDelayCounter > 50) { fMoveTargetX = fObjGrabX -0.55 + grab_forward_offset; fMoveTargetY = 0; @@ -604,7 +604,7 @@ void ProcCloudCB(const sensor_msgs::PointCloud2 &input) nTimeDelayCounter++; VelCmd(0,0,0); - if(nTimeDelayCounter > 50) + if(nTimeDelayCounter > 30) { nTimeDelayCounter = 0; nStep = STEP_OBJ_UP; @@ -623,7 +623,7 @@ void ProcCloudCB(const sensor_msgs::PointCloud2 &input) } nTimeDelayCounter++; VelCmd(0,0,0); - if(nTimeDelayCounter > 50) + if(nTimeDelayCounter > 10) { fMoveTargetX = -(fTargetGrabX-0.4); fMoveTargetY = 0;