sravan/Control-Project
1
0
Fork 0
mirror of https://github.com/ROB-535-F21-Team-3/Control-Project.git synced 2025-08-26 20:02:45 +00:00
Code Issues Packages Projects Releases Wiki Activity

Re-Organize Files Again

Browse Source 
- Deliverables folder holds final files for submission
- Experimentation holds scripts and things related to our development of
  a final solution
- Simulation holds the provided files
- Added template for part 2 submission with comments
This commit is contained in:
Sravan Balaji
2021-11-30 11:17:24 -05:00
parent b0ad7defd3
commit 33945f6414
15 changed files with 40 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

27
Simulation/senseObstacles.m Normal file
View File

@@ -0,0 +1,27 @@
function Xobs_seen = senseObstacles(curr_pos, Xobs)
% Xobs_seen = senseObstacles(curr_pos, Xobs)
%
% Given the current vehicle position, sense the obstacles within 150m.
%
% INPUTS:
% curr_pos a 2-by-1 vector where the 1st and 2nd elements represent the
% x and y coordinates of the current vehicle position
%
% Xobs a cell array generated by generateRandomObstacles.m
%
% OUTPUTS:
% Xobs_seen a cell array which contains all obstacles that are no
% greater than 150m from the vehicle. Each cell has the same
% structure as the cells in Xobs.
%
% Written by: Jinsun Liu
% Created: 31 Oct 2021
Xobs_mat = cell2mat(Xobs');
dist = (Xobs_mat(:,1) - curr_pos(1)).^2 + (Xobs_mat(:,2) - curr_pos(2)).^2;
idx = unique(ceil(find(dist<=150^2)/4));
Xobs_seen = {Xobs{idx}};
end