A trajectory optimization method for close range surveys of non-planar surfaces