Implementierung und Test einer kollaborativen Trajektorienplanung zwischen Mensch und Roboter