added example for forward kinematics, changed s1 to relative angle. forward and inverse kinematics seems to work now although only each with their own parameter set. maybe i need to do an optimization run and see if i can find parameters that work both at the same time...