Enabled SolvePnP for search 6-dimensional vector of displacement object

Needed investigation. Bad projection. (see issue#5)