http://dx.doi.org/10.1016/j.robot.2008.04.001