Sarcos Sapien 6M Digital Twin

I developed a digital twin of the Sarcos Sapien 6M robotic manipulator. Frames were generated using Denavit–Hartenberg conventions. Controllers were generated for analytical inverse kinematics as well as numerical inverse kinematics. The algorithms were tested on a Sarcos Sapien 6M and the robot was able to successfully perform a tool change as commanded in the simulation.