An Onboard Framework for Staircases Modeling Based on Point Clouds