[C++] bodies are now a subpart of the Frames : some Frames are of type BODY and when referring to getBodyId/Name in Model it will look in its frames

[C++][unittest] Fixed dynamics unittest. Initialize jacobians variables to avoid undefined behaviours