https://123dok.net/document/7q0o153q-multi-variable-constrained-control-approach-for-a-three-dimensional-eel-like-robot.html