Working on newFloor algorithm