Agregue una solucion factible de ejemplo, asi resulta mas facil testear las otras funciones que estan haciendo. Tengo una imagen que grafica dicha solucion en caso de que la necesiten.