Managed ArrayOutOfBoundsExeption caused by floor = -1 and lowered the processortime needed by ElevatorController while(true) loop