retrieve current velocity of the robot from TF
-added new service
-added callback function in pose_estimation
-added functioncall from motion_control