BIK: Full Body IK Solver

Doing some more testing before 0.3 release