Oohhh maaan -.- das war die Lösung xD
Ich denk halt immer komplizierter als es ist :P Naja bin ja auch erst seit 1ner Woche in der Robotik dabei Bild  

Vielen Dank! Hätte warscheinlich noch Stunden gegrübelt xD

MfG. mtzE