Fixed issue #5. Tracker works good EVEN with our video!!!

Fixed incorrect updating pose (RAPIDTracker.cpp: 259)