Insertion sort

Added insertion sort and tests for sort