Added result check in solve_2_bones in SkeletonFitting
solve_2_bones now takes two arguments that indicate which bones are to be solved.
Previously it would only solve for root and first child.