Source: http://se.inf.ethz.ch/people/rusakov/data/publications/rusakov_iros14.pdf