Final year project; wall following algorithm