update
3D global planning
add TODOs
init for future
randomizing cock poses for sim/dummy
moving setup files
Merge branch 'nav-10'
Pushed milestone1 legacy programs
Merge pull request #59 from lintangsutawika/milestone1

Pushed milestone1 legacy programs