Added IK solver for each way-point. When out of IK solution marker is changed from blue to yellow. The IK solver has 1 itteration and 0.001 seconds timeout for achieving smoother update during user interaction
Merge branch 'master' of https://github.com/ros-industrial-consortium/fermi