Dovresti postare anche il codice, hai esposto il tuo algoritmo, ma non è certo che ci sia corrispondenza con il codice scritto.