find and estimate are not const

They update the persistence cache. Not sure this needs to be hidden from the
interface.
bugfix: wrong use of erase in CachingFilter
bugfix: incomplete computation of the proj matrix
Reapplied persistence after the pose estimation