http://dx.doi.org/10.1109/ICRA.2018.8461088