How to write c code for greedy algorithm