Kinodynamic Motion Planning via Funnel Control for Underactuated Unmanned Surface Vehicles