Vision for off road autonomy