Added delay functionality from systick