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",
+    ],
+)