Add insertion sort algorithm implementation & unit tests