Refactoring
Clean up code
Improved feature tracker
Fix mem leak (ouch.)
Video output