added gravity term to dynamics

Description

• Added gravity term to dynamics

Reviewers

• @alexandros
• @amyblank
• @bz
• @cm
• @tn
• @lr

Resources

Robot Modeling and Control by Spong et al, chapter 7. (Equation 7.146 is the one that includes gravity.)

Issues

• Fixes #183