Initial commit with elevator code working for 1 elevator