Task priority control of underwater intervention systems: Theory and applications