Added basic line following algorithm