Mandatory assignment 3

For code and setup guides for mandatory assignment 3 have a look at our git repositories at

https://github.uio.no/UNIK4490

Also for the groups doing the motion control assignment. Right now only the forward kinematics is out. Later we will publish the Jacobian and limited dynamics of the robot (only gravity). So I would advise to implement a PD controller with gravity compensation. Either in joint space or operational space.