Hola que tal.
Los algoritmos que buscas los puedes encontrar facilmente en cualquier libro referente a estructuras de datos y algoritmos.
Asi que te recomiendo que te busque el algoritmo y hagas los programas, ya que es bien facil y rapido programarlos.
Si tuviera los programas en c++, tal vez te los pasaria, pero solo los tengo en prolog, los cuales no creo que te sirvan ya que prolog es un lenguaje declarativo y no es igual a c++
Claro que si te sirven asi, por mi no hay problema.
Hasta luego, y espero no te moleste mi comentario.