Real robot move abnormal when connecting with moveit
Hi, everyone!
My robot arm was connected with MOVEIT by rosserial
and I have succeed to bulid a hardware interface between them(JointStateInterface
& VelocityJointInterface
). But after I launch MOVEIT(demo.launch) , robot trembling at first, then keep moving until interference occurs.
- Due to the limitation of sensor, I can't get a stable value of the robot. So I reduced the sensor resolution to 0.01. The graph below shows Fluctuation of readings.
- I have tried to reverse motor rotation and get a same result.
- When readings from robot dose not fluctuate, all cmd out put "0". As long as reading start to fluctuate, the value output from cmd will become biger and biger and will not decrease again.
- I have tried to edit the value of PID but didn't work.No matter how much I reduce the value of I and D, it just makes the chaos comes a little later.
- I have disable the simulation in demo.launch and sure that both ROS and hareware can get true value through the rosserial.
How should I do to solve this problem? How can I control my robot with VelocityJointInterface? Thank you very much!