A control system supporting motion of an underwater robotic vehicle along a reference trajectory in the vertical plane is presented in the paper. A waypoint line-of-sight scheme and PD control law are applied to calculate command signals. Parameters of the proposed control law are tuned using genetic algorithms. The validity and advantages of the approach are illustrated through numerical simulation results.