Add searching, sorting code
Fix InsertionSort