- add scene elements for visualization
- add example that displays top down and projection to camera image

- add pid controller
- add pid controller for rotate then move
- add example using pid to reach waypoint