Set all actuation to zero before and after main control loop
Added a bit more graceful termination on ctrl-c