Milestones
- Model a 6-DOF manipulator with our own dimensions in a URDF file and test it in RViz.
- Use MoveIt to plan a trajectory to a given Cartesian goal and visualize the motion of the robot in RViz.
- Use the joint angles from MoveIt as setpoints for a PID controller on each joint in Gazebo, and reach the desired goal.


