compil ok
final fix jointFwd
remove robot instance parameter
final nuOfFwdDyn on arm and humanoid