changing msgs to geometry_msgs/PoseStamped, moving loop_rate and other variables to header file