@Jon-vdk I suggest you take a look at https://github.com/Duet3D/RepRapFirmware/wiki/Adding-New-Kinematics.