add catkin_find_pkg script

@tfoote @wjwwood Please review.