got trajectoryrobot2d working