This was the capstone project for MEC529: Introduction to Robotics. The course itself saw a high utility of linear algebra and applied math concepts to understand configuration space and topology to help control the motion and trajectory of a robot according to a desired task.