3D Mapping and Stability Prediction for Autonomous Wheelchairs