Reverts and small changes.

Back to using Bezier where it was originally used.
Also changed goal target back to original full goal line, instead of
smaller 'accurate' goal line.
Ensure that the robot can get close to the goal line to save or roll
ball into goal.