Upgrade Insert Sort

Signed-off-by: hurley25 <liuhuan1992@gmail.com>