Fix for height estimation