Code:
   stop();
   while(1) task_motionControl(); // oje
   return 0;
(ungetestet)