Source: https://www.control.isy.liu.se/student/graduate/robot/files/labPrepAndEx.pdf