Fixed paths and stuff so it builds
Add SixenseSDK, split main cpp into cpp+header