New version of Foward Kinematics and method to add gsl to codeblock