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