Got basic distance measurement and display working again.