Switch to use systick and split lcd stuff into different file
Adding delay_ms() function