added v_curve, acc, final vel in polar controller, not working correctly yet.