Fixed all changes needed for pick_place_action_server.cpp