Update AngleTest to new drive formulä, now tests full circle