Arduino is freezing after running function twice