Added first attempt at 3D reconstruction. Tested for no segfaults, not tested for correctness.
Merge branch 'master' of github.com:acm-uiuc/Quadcopter