Add Sorting Algorithm Template

Add Insertion sort function.