Trajectory alignment to robot
- Removed rotation component from trajectory, replaced it with trajectory's tangent