Now using pid controllers for aligning and following