added the p4pf solver
added P5Pfr and fixed a small bug in P4Pf
added P5Pfr and fixed a small bug in P4Pf
updated include file for new pose solvers