how to realize trajectory tracking?

[hengxiangchen]

thanks for this awesome job!

however, i am wandering if the trajectory tracking codes exist?

thanks again for your reply.