Add OpenMP for all part

Fix a bug in detect keypoint angle