Tror algoritmen är klar.

Tror att själva algoritmen är klar nu, bara småfunktionerna kvar nu.