Cleanup and Updates

Changed multiple if-else statements to switch. Fixed not reading from
serial. It was reading from pin A0 for no reason.