Added rospy shutdown handler