A Task Priority and Dynamic Programming Based Approach to Agile Underwater Floating Manipulation