Implemented first method of the block world problem.