Fixes small typo in a comment explaining an equation
Provided names to elements, provided nondefault values for masses

Helped me with the debugging, to see who's worked on, how values are computed and populating terms in the EOMs, etc.
Avoids inquiring about the size of two vectors (constraints and variables) at each iteration of several loops.