Simulation of LOS Path Following and SBG Obstacle Avoidance for USV