fixed User Interaction Arrow on button click update. Bug fixes in RViz interaction enviroment. Clean cartesian planner code.