I am trying to write a control node so my urdf robot moves along a certain path like a triangle or simply patrol between two points. My current approach is to use publish co