IntegratedControlPlanning_MATLAB The MATLAB script "Proposed_Algorithm_Simulation.m" simulates the proposed algorithm.