Final Version

What's Changed

• Tested FK To Match DH Table by @Zac-BB in #5
• Diff kinematics by @Zac-BB in #6
• Inverse kinematics by @Zac-BB in #7

New Contributors

• @Zac-BB made their first contribution in #5

Full Changelog: https://github.com/Zac-BB/RBE501dVRKModeling/commits/final