Vehicle visual navigation algorithm based on detect of horizon