Cleaned up and fixed InsertionSortWithBinarySearch