mirror of
https://github.com/6-robot/wpb_home.git
synced 2025-09-15 12:58:59 +08:00
mani_test
This commit is contained in:
parent
b36184e35d
commit
3ef6ab5007
@ -43,7 +43,7 @@
|
||||
#define WPBH_TEST_MANI_UP 2
|
||||
#define WPBH_TEST_MANI_FOLD 3
|
||||
|
||||
#define CMD_WAIT_SEC 6
|
||||
#define CMD_WAIT_SEC 10
|
||||
|
||||
static int nState = WPBH_TEST_MANI_ZERO;
|
||||
static int nCount = 0;
|
||||
@ -70,7 +70,7 @@ int main(int argc, char** argv)
|
||||
ROS_INFO("[Mani] ZERO -> DOWN... %d",nCount);
|
||||
if (nCount == 0)
|
||||
{
|
||||
m_wpb_home.ManiCtrl( 11200, 1000, 50000, 1000);
|
||||
m_wpb_home.ManiCtrl( 11200, 1000, 50000, 80);
|
||||
}
|
||||
nCount ++;
|
||||
if(nCount >= CMD_WAIT_SEC)
|
||||
@ -83,7 +83,7 @@ int main(int argc, char** argv)
|
||||
ROS_INFO("[Mani] DOWN -> UP ... %d",nCount);
|
||||
if (nCount == 0)
|
||||
{
|
||||
m_wpb_home.ManiCtrl( 55000, 1000, 0, 1000);
|
||||
m_wpb_home.ManiCtrl( 55000, 1000, 50000, 80);
|
||||
}
|
||||
nCount ++;
|
||||
if(nCount >= CMD_WAIT_SEC)
|
||||
@ -96,7 +96,7 @@ int main(int argc, char** argv)
|
||||
ROS_INFO("[Mani] UP -> DOWN ... %d",nCount);
|
||||
if (nCount == 0)
|
||||
{
|
||||
m_wpb_home.ManiCtrl( 11200, 1000, 0, 1000);
|
||||
m_wpb_home.ManiCtrl( 11200, 1000, 0, 80);
|
||||
}
|
||||
nCount ++;
|
||||
if(nCount >= CMD_WAIT_SEC)
|
||||
@ -109,7 +109,7 @@ int main(int argc, char** argv)
|
||||
ROS_INFO("[Mani] DOWN -> ZERO ... %d",nCount);
|
||||
if (nCount == 0)
|
||||
{
|
||||
m_wpb_home.ManiCtrl( 0, 1000, 0, 1000);
|
||||
m_wpb_home.ManiCtrl( 0, 1000, 0, 80);
|
||||
}
|
||||
nCount ++;
|
||||
if(nCount >= CMD_WAIT_SEC)
|
||||
|
||||
File diff suppressed because one or more lines are too long
@ -1,7 +0,0 @@
|
||||
image: map.pgm
|
||||
resolution: 0.050000
|
||||
origin: [-25.624998, -25.624998, 0.000000]
|
||||
negate: 0
|
||||
occupied_thresh: 0.65
|
||||
free_thresh: 0.196
|
||||
|
||||
Loading…
Reference in New Issue
Block a user