Forward Kinematics and Jacobian generator BETA
Change control mode by pressing 'Q'. 'W' and 'E' switches between position and orientation in inverse mode
Copyright © Lars Ivar Hatledal @ Aalesund University College