Add active sensing

- add generation of yaw based on information constraints
- add solving of convex program for yaw
- add cylinder scene objects
- add example showing generated yaw plan