https://9pdf.net/document/y8g3rgj2-collision-avoidance-velocity-obstacle-algorithm-underactuated-surface-vehicles.html