16-384 Robots Kinematics and Dynamics (RKD) Capstone Project