Added callback functions for elevator. Add support for configurable floor heights in the SDF model