bueno el siguiente codigo no esta orientado a objetos sino esta estructurado pero no creo q aya problema, no se si estas llevando POO o Estructura de datos, pero o es pura coincidencia pero por el codigo que muestras eres del ITTG y te esta dando clases Pedro Pablo, bueno checalo y espero t sirva.