From 4799bac070dad70d6cd3f47163bc481d1f8f6ffa Mon Sep 17 00:00:00 2001
From: YanzhenXiangRobotics <xyz000327@gmail.com>
Date: Thu, 27 Apr 2023 13:23:44 +0200
Subject: ADD: plot traj

---
 templates/simulate.m         | 1 +
 templates/traj_constraints.m | 1 +
 2 files changed, 2 insertions(+)

diff --git a/templates/simulate.m b/templates/simulate.m
index 20c77b2..6100434 100644
--- a/templates/simulate.m
+++ b/templates/simulate.m
@@ -22,6 +22,7 @@ function [Xt,Ut,ctrl_info] = simulate(x0, ctrl, params)
         x = params.model.A*x + params.model.B*u;
         Xt = [Xt x];
     end
+    plot_trajectory(Xt, Ut, ctrl_info, params);
 % Ut = u;
 % Xt = x;
 
diff --git a/templates/traj_constraints.m b/templates/traj_constraints.m
index 4b0a081..d8ace29 100644
--- a/templates/traj_constraints.m
+++ b/templates/traj_constraints.m
@@ -8,5 +8,6 @@
 
 function [s_max, y_max, u_max, J_u, df_max, vf_max, traj_feas] = traj_constraints(x,u,params)
     % YOUR CODE HERE
+    s_max = 
 end
 
-- 
cgit v1.2.1