BIM-Constrained Optimization for Accurate Localization and Deviation Correction in Construction Monitoring