Source: http://asl.stanford.edu/wp-content/papercite-data/pdf/Iglesias.Rossi.Zhang.Pavone.WAFR16.pdf