Source: https://robotik.informatik.uni-wuerzburg.de/telematics/download/3dresearch2011.pdf