Source: https://www.federico.io/pdf/Iglesias.Rossi.Zhang.Pavone.IJRR18.pdf