Target frame of the way-points and interactive marker is set from the robot model. IK Solver is set to 1 itteration 0.001 sec,timeout for each itteration. Code cleanup and partial renaming according to the midterm code review.