update
3D global planning
add TODOs
init for future
randomizing cock poses for sim/dummy
moving setup files
Merge branch 'nav-10'