Updated tape following

This code now allows the robot to tape follow! (We do need some chassis
improvements though)