This is an extension of the 2-link robot model that includes body rotation, wrist and end effector. Each component has a 3D CAD object attached to it to create a visualization of the full robot. The movement of the manipulator is controlled to minimize the time required for a set path.