This repo gives a pkg that you can use to control auv by giving trajectory, a using case will be given after my paper been received.