Adding a control-based planner

animated-under-construction-image-0035

Defining the robot kinematics

Section 2

Section 3