Added rospy shutdown