Fix initialization of basic structures.

Because some of the data structures were not initialized to zero,
the value was too small and generated denormalization raising the
computational cost.
This commit fixes this issue.
Fix joint_F initialization issue.
This commit allows a proper initialization  of the robot models.