Tillsnyggad kod uppdelad i funktioner. Reset och INT2-avbrott fungerar nu.