Course project for ME384R: Advanced Dynamics of Robotic Systems