Base elevator code ready for debugging

Basic code ready for debugging and testing.