3D measurement and display for augmented reality