Update add_way_point.cpp

Uncomment line #L294 to enable simultaneous update of the tree view once the pose of the User interaction marker and the Way-Point is updated from RViz.