Weitere Arbeiten am PID Regler und an den MotionCommands