Improved leg fitting.

Introduced new gradient method that tries to fit the bones when direct
fitting fails. Used when fitting wrist and elbow
DebugUtil added cout methods for float3 and float4.
SkeletonController fix error on selecting bones for ik solver.

If root bone was to be selected negative index would be given to
the ik solver.