Fixed some bugs with serial baudrate overflow + declaration in switch
Should be working, need to fix the sleep