sravan/Control-Project
1
0
Fork 0
mirror of https://github.com/ROB-535-F21-Team-3/Control-Project.git synced 2025-09-05 07:33:14 +00:00
Code Issues Packages Projects Releases Wiki Activity

change to phi bounds

Browse Source
This commit is contained in:
xdemenchuk
2021-11-28 18:53:09 -05:00
parent 81363e8e2a
commit cc4d3a4ea2
15 changed files with 1589 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

8
SimPkg_F21(student_ver)/xenia_nonlinearopt.m
View File

@@ -52,8 +52,8 @@ function [lb, ub] = bounds(StepsPerPoint)
phi_init = TestTrack.theta(1);
%phi restricted to just [-pi/2 pi/2]
lb = [min(bound_X); -Inf; min(bound_Y); -Inf; -(pi/2); -Inf];
ub = [max(bound_X); Inf; max(bound_Y); Inf; +(pi/2); Inf];
lb = [min(bound_X); -Inf; min(bound_Y); -Inf; -pi); -Inf];
ub = [max(bound_X); Inf; max(bound_Y); Inf; +pi; Inf];
for i=1:nPts
@@ -66,8 +66,8 @@ function [lb, ub] = bounds(StepsPerPoint)
TestTrack.br(2,prev_idx), TestTrack.br(2,next_idx)];
phi_init = TestTrack.theta(i);
lb_x = [min(bound_X); -Inf; min(bound_Y); -Inf; -(pi/2); -Inf];
ub_x = [max(bound_X); Inf; max(bound_Y); Inf; +(pi/2); Inf];
lb_x = [min(bound_X); -Inf; min(bound_Y); -Inf; -pi; -Inf];
ub_x = [max(bound_X); Inf; max(bound_Y); Inf; +pi; Inf];
for num = 1:StepsPerPoint
lb=[lb;lb_x];