Added rospy shutdown handling.