Fix some cases of divergence in the physics model
Signed-off-by: justinT21 <jjturcot@gmail.com>
Change-Id: Ib6e322af67ef66567b528802f145ba263554af88
diff --git a/frc971/control_loops/swerve/BUILD b/frc971/control_loops/swerve/BUILD
index 4fd73d2..052b287 100644
--- a/frc971/control_loops/swerve/BUILD
+++ b/frc971/control_loops/swerve/BUILD
@@ -129,11 +129,13 @@
outs = [
"dynamics.cc",
"dynamics.h",
+ "dynamics.py",
],
args = [
"--output_base=$(BINDIR)/",
"--cc_output_path=$(location :dynamics.cc)",
"--h_output_path=$(location :dynamics.h)",
+ "--py_output_path=$(location :dynamics.py)",
],
tool = ":generate_physics",
)
@@ -146,3 +148,18 @@
"@org_tuxfamily_eigen//:eigen",
],
)
+
+py_binary(
+ name = "dynamics_sim",
+ srcs = [
+ "dynamics.py",
+ "dynamics_sim.py",
+ ],
+ deps = [
+ "//frc971/control_loops/python:controls",
+ "@pip//matplotlib",
+ "@pip//numpy",
+ "@pip//pygobject",
+ "@pip//scipy",
+ ],
+)