add depth support navigation, finally!!! Not super happy but better, needs improvements in cornering