High Precision Phase Error Compensation Algorithm for Structural Light Measurement