Merge pull request #35 from twiniars/master

fix
irp6p_tfg kinematic
irp6p_tfg addition in progress