Changed control loop cycle to 5.05 ms
Change-Id: If2a1e1ab01e051798fdaff77914a418ab2136f2c
diff --git a/y2017/control_loops/python/polydrivetrain.py b/y2017/control_loops/python/polydrivetrain.py
index f20ec2f..d3a5683 100755
--- a/y2017/control_loops/python/polydrivetrain.py
+++ b/y2017/control_loops/python/polydrivetrain.py
@@ -112,7 +112,7 @@
super(VelocityDrivetrainModel, self).__init__(name)
self._drivetrain = drivetrain.Drivetrain(left_low=left_low,
right_low=right_low)
- self.dt = 0.005
+ self.dt = 0.00505
self.A_continuous = numpy.matrix(
[[self._drivetrain.A_continuous[1, 1], self._drivetrain.A_continuous[1, 3]],
[self._drivetrain.A_continuous[3, 1], self._drivetrain.A_continuous[3, 3]]])
@@ -178,7 +178,7 @@
[[-12.0000000000],
[-12.0000000000]])
- self.dt = 0.005
+ self.dt = 0.00505
self.R = numpy.matrix(
[[0.0],