Speed and Heading Control of an Unmanned Surface Vehicle Based on State Error PCH Principle

Figure 1

The motion coordinate system for USV.