Added proper keypoint calculation, storage and drawing. Added some synchronisation. Added initialization functions. Works release&debug in msvs 2010.