added dummies for robot links
corrected all links and joints offsets
some pathplanning trials