偷点懒直接上代码吧,这段代码也不是很复杂,按照直接插入算法的描述写的。