Use solvePnP iterative with initial guess

This stabilize quite a lot solvePnP
Uses a combination of nb of inliers + ratio inliers/matches to switch to tracking
Add an eroded mask to detect goodFeaturesToTrack

The idea is to avoid the edges of the template where the background
is likely to disturb quite a bit the tracking