fai con google una ricerca sui principali algoritmi di ordinamento.
Vedi che ne troverai uno che fa al caso tuo. Tutto sta a tradurlo nel linguaggio che ti interessa (c++)