Working InsertionSort and fixed small bug in BubbleSort