See http://wiki.ros.org/stair-step-detector for more details.