Dynamic Autonomous Surface Vehicle Control and Applications in Environmental Monitoring