Code for Guide smartcup for the visually impaired with team Vector United