Start adding  lego-based depth code
Added missing include
Remove pthread from lightstart.h, fix kill time
Added new cbc depth aligning, works now
Added way to safely open the Xtion, without can corrupt memory!
Improve some comments
Added midpoint Xtion lego function