Added segmentQuery for cp.space
Added test for pointQuery, nearestPointQuery, segmentQuery