Abstract
A dynamic path-planning algorithm based on a general constrained optimization problem (GCOP) model and a sequential quadratic programming (SQP) method with sensor input is proposed in this paper. In an unknown underwater space, the turtle-inspired amphibious spherical robot (ASR) can realise the path-planning control movement and achieve collision avoidance. Due to the special underwater environments, thrusters and diamond parallel legs (DPLs) are installed in the lower hemisphere to realise accurate motion control. A propulsion model for a novel water-jet thruster based on experimental analysis and a modified Denavit-Hartenberg (MDH) algorithm are developed for multiple degrees of freedom (MDOF) to realize high-precision and high-speed motion control. Simulations and experiments verify that the effectiveness of the GCOP and SQP algorithms can realize reasonable path planning and make it possible to improve the flexibility of underwater movement with a small estimation error.