Added a function to convert generated points to Billy friendly coordinates and a inverse kinematics with variable arm lengths