[fix] fix trajectory for rotated world