Source: http://www.dia.fi.upm.es/~pcr/publications/iros2018.pdf