Follow The Marker

Here the head of the snake (manipulator) follows the marker in my hand. The marker is tracked my Motion Capture system. And the snake uses Rapidly Growing Random Trees algorithm in order to reach the marker.