@isucan what are your *initial thoughts on this kind of change to kinematics_base.h? it maintains a vector of tip frames instead of just one, and allows you to optionally call searchPositionIK with a vector of poses. It requires no backwards compatibility changes to kdl/ikfast

this PR is by no means cleaned up and is against my own branches.