unsmooth trajectory in when using scaled trajectory controller for hybrid planning

[santoshbalaji]

The following are the setup I have currently

ROS2 Humble Moveit2 Hybrid planner UR Driver with Scaled joint trajectory controller UR16e robot

When I try to use hybrid planner to send real UR robot to a specific point the executed motion seems more jerky and it is not smooth. When I try to do some analysis the following is observed.

Local planner (Hybrid planner) -> Trajectory (Start point) -> Scaled joint trajectory Controller

Local planner (Hybrid planner) -> Trajectory (Via point) -> Scaled joint trajectory Controller

Local planner (Hybrid planner) -> Trajectory (Via point) -> Scaled joint trajectory Controller

Local planner (Hybrid planner) -> Trajectory (Goal point) -> Scaled joint trajectory Controller

Because of the above operations the joint trajectory controller was not able to maintain constant velocity as these controllers looks like designed to get all positions in one single step to maintain constant velocities. Let me know if above assumptions are correct. What can be done to mitigate this issue ?. I was thinking of modifying the controller to queue up the commands and keep planning to maintain constant velocities. Require suggestion on directions.

Thanks in advance !!!!