I am implementing a simple robot behavior where the robot represented as a box picks an object and drops it at a goal location. However, when the robot reaches the object location to pick it, it doesn't pick it.
A simplified version of the task has been attached [mp_pick_drop.cc](/upfiles/14843131697146674.cc)
All it does is to attach the m_litter to this->model and change the pose of the robot. This doesn't work, as the box just stays frozen at initialized pose. Please what am I getting wrong?
**I am using gazebo 7**
my robot model is a simple box.[Robot sdf](/upfiles/14843221975893251.sdf) 
object to pick (m_litter) is also a simple red box.[object sdf](/upfiles/1484322236865652.sdf) 
The world is [world sdf](/upfiles/14843223016090593.world) 
Many thanks in advance. The complete plugin source code is 
↧