Performances improvements and first test with new classifier and rotation vector