Expanded moving average of angles. Removed one hack. Removed left-turn constraint. Improved distance reading. Bad Triangulation.