debug and creating separate launch for trajectory visualization and moving real lwr
testing