Add climber servo code
Used for traversing to high bar.
Signed-off-by: Milind Upadhyay <milind.upadhyay@gmail.com>
Change-Id: I333c581c33aab3f2d960db8452b5b1783aab9a5a
diff --git a/y2022/control_loops/python/climber.py b/y2022/control_loops/python/climber.py
index fd1707b..5f5ae38 100755
--- a/y2022/control_loops/python/climber.py
+++ b/y2022/control_loops/python/climber.py
@@ -17,7 +17,7 @@
kClimber = linear_system.LinearSystemParams(
name='Climber',
motor=control_loop.Falcon(),
- G=(1.0 / 10.0) * (1.0 / 3.0) * (1.0 / 3.0),
+ G=(1.0 / 4.0) * (1.0 / 3.0) * (1.0 / 3.0),
radius=22 * 0.25 / numpy.pi / 2.0 * 0.0254,
mass=2.0,
q_pos=0.10,