Move and rename from Skeleton::solveInvKinematics() to BodyNode::fitTransform()

Add BodyNode::fitLinearVel() and BodyNode::fitAngularVel()