A Novel Fast Marching Approach for COLREGS Compliant Dynamic Obstacle Avoidance for Unmanned Surface Vehicles