Added start/stop for serial communication
Various small fixes