First version of inverse kinematics to create hrKinematics library that depends on hrCore