Code : preliminary logic for terrain height estimation inhibit
Code : Improve efficiency of optical flow Kalman gain calculation