Improved depth calculation and put in speed control.