Debug marker to joint trajectory conversion