Final integrated system, including simulation, crowd navigation for experimental scenario

Summary
Final integrated system including simulation crowd navigation for experimental scenario