HIGH-ACCURACY, HIGH-SPEED 3D OPTICAL SENSING IN UNSTRUCTURED ENVIRONMENTS