Added tunable turn acceleration to drivetrain profile.
Change-Id: I0f110f10f181e4f897e06b116a6cd67cc45f7f0a
diff --git a/frc971/actors/drivetrain_action.q b/frc971/actors/drivetrain_action.q
index 6da2280..9ad55d3 100644
--- a/frc971/actors/drivetrain_action.q
+++ b/frc971/actors/drivetrain_action.q
@@ -10,6 +10,8 @@
double theta_offset;
double maximum_velocity;
double maximum_acceleration;
+ double maximum_turn_velocity;
+ double maximum_turn_acceleration;
};
queue_group DrivetrainActionQueueGroup {
diff --git a/frc971/actors/drivetrain_actor.cc b/frc971/actors/drivetrain_actor.cc
index 78724f6..1544cd0 100644
--- a/frc971/actors/drivetrain_actor.cc
+++ b/frc971/actors/drivetrain_actor.cc
@@ -39,10 +39,11 @@
profile.set_maximum_acceleration(params.maximum_acceleration);
profile.set_maximum_velocity(params.maximum_velocity);
- turn_profile.set_maximum_acceleration(
- 10.0 * constants::GetValues().turn_width / 2.0);
- turn_profile.set_maximum_velocity(3.0 * constants::GetValues().turn_width /
- 2.0);
+ turn_profile.set_maximum_acceleration(params.maximum_turn_acceleration *
+ constants::GetValues().turn_width /
+ 2.0);
+ turn_profile.set_maximum_velocity(params.maximum_turn_velocity *
+ constants::GetValues().turn_width / 2.0);
while (true) {
::aos::time::PhasedLoopXMS(5, 2500);