Add QP based IK function

[RemiFabre]

The idea is to add the possibility to choose the IK function statically (maybe with a big IF) between KDL and QP.