Fix IDyM for robots with flexible joints

Modify so that all the required terms including that of link 0 are
computed.
Update new robot creation

Update new robot creation to automatically preserve the joint
parameters.