1. Multiple AMV Trajectory Planning Using the PRONTO TK Andreas J. Husler Instituto Superior Tcnico Institute for Systems and Robotics Dyanamical Systems and Ocean Robotics Laboratory Lisbon, Portugal

2. About me From Bavaria, but living in Portugal for almost 5 years PhD Student in Marine Robotics at Instituto Superior Tcnico (Lisbon, Portugal) Currently working on Trajectory Planning and Generation for Multiple Marine Vehicles CU Boulder, May 4, 2012 2A. Husler 3. Some Not-So-Important Trivia Arrived at Boulder in January with wife and daughter will return to Lisbon in roughly a week had a great time at CU and in Colorado CU Boulder, May 4, 2012 A. Husler 3 The Huslers coat of arms (1632) 4. Introduction Efficient algorithms for multiple vehicle trajectory planning are crucial for cooperative control systems Need to take into account vehicle dynamics, mission parameters and external influences Aim for minimum energy usage CU Boulder, May 4, 2012 4A. Husler 5. Path Planning System MULTIPLE VEHICLE PATH PLANNING SYSTEM Initial Positions Initial Velocities Final Positions Final Velocities Cost Criterion (e.g. weighted sum of energies, maneuvering time) Vehicle Model & Hydrodynamics Collision Avoidance Constraints Mission Parameters (e.g. obstacles, bathymetric map) Feasible Trajectories CU Boulder, May 4, 2012 5A. Husler 6. What it Really Looks Like CU Boulder, May 4, 2012 A. Husler 6 Initial State & Input Final State & Input Initial Guess Dynamics Trajectory Revised Guess Expected Energy Trajectories Safety Distance Comm. Constraint Cost Criterion Current Obstacles Desired Trajectory BatymetricData AMV Data Projection Operator Magic Newton Method Mission Specifications CoordinatedTrajectory TrackingController Pre- Planner Environmental Constraints SupervisingMission Operator 7. The MEDUSA ASV Semi-Submersible Two Thrusters (Seabotix HPDC 1507) 1035mm 300mm 840mm total Max. Speed 1.5 m/s Originally designed for diver assistance/harbor patrolling scenarios CU Boulder, May 4, 2012 A. Husler 7 8. Dynamic Model Assumption: since the MEDUSA is a surface craft, we can safely consider only 2D dynamics (i.e. ignore roll and pitch dynamics) The vessel is controlled with common and differential thrust (two thrusters, no rudders) This gives us 3 kinematic states + 3 dynamic states + 2 inputs CU Boulder, May 4, 2012 A. Husler 8 9. Dynamic Model Kinematics = cos sin 0 sin cos 0 0 0 1 Dynamics + + + + = where = and = + 0 Inputs and CU Boulder, May 4, 2012 A. Husler 9 10. Thruster Model Due to design: negligible propeller-hull interaction Four-quadrant propeller model = 1 2 2 + 2 2 = 1 2 2 + 2 2 where = sin atan2 , + = + = 0.7 = 0.72 CU Boulder, May 4, 2012 A. Husler 10 11. DC Motor Model Standard DC motor equations + = + = For now, assume sufficiently fast dynamics steady state equation for voltage = + = + 2 Current map obtained from measurements = 3 + 2 + + CU Boulder, May 4, 2012 A. Husler 11 12. Cost and Constraints Using the motor model, the instantaneous power requirement is = + + Additionally: desired traj. (using 2 minimization) Additionally: inter-vehicle collision and obstacle avoidance constraints (using log barrier function) 2 2 2 + 2 2 2 1 0 CU Boulder, May 4, 2012 A. Husler 12 13. Results Scenario: 3 Medusas and 2 obstacles Desired trajectories passing through obstacles & causing collisions Result: collision-free trajectories through narrow passage CU Boulder, May 4, 2012 A. Husler 13 14. Illustration: Armijo Exploration CU Boulder, May 4, 2012 A. Husler 14 15. Illustration: Morphing Trajectories CU Boulder, May 4, 2012 A. Husler 15 16. Illustration: Trajectory Tracking CU Boulder, May 4, 2012 A. Husler 16 17. Open Issues & Outlook Issues with the four-quadrant model still prevent 2nd order descent Gains need to be tweaked Incorporate mission performance metrics la Naomi Leonard Use a (propably topology-based) pre-planning method for global optimal (in some discrete sense) initial guess CU Boulder, May 4, 2012 A. Husler 17 18. Questions? Comments? Suggestions? CU Boulder, May 4, 2012 A. Husler 18