Fixed autostop
Removed debugging Serial messages