Found the bug (maybe :D) and added the Emergency Stop in the drivesystem