A Hyper-redundant Elephant’s Trunk Robot with an Open Structure: Design, Kinematics, Control and Prototype

Abstract

As for the complex operational tasks in the unstructured environment with narrow workspace and numerous obstacles, the traditional robots cannot accomplish these mentioned complex operational tasks and meet the dexterity demands. The hyper-redundant bionic robots can complete complex tasks in the unstructured environments by simulating the motion characteristics of the elephant’s trunk and octopus tentacles. Compared with traditional robots, the hyper-redundant bionic robots can accomplish complex tasks because of their flexible structure. A hyper-redundant elephant’s trunk robot (HRETR) with an open structure is developed in this paper. The content includes mechanical structure design, kinematic analysis, virtual prototype simulation, control system design, and prototype building. This design is inspired by the flexible motion of an elephant’s trunk, which is expansible and is composed of six unit modules, namely, 3UPS-PS parallel in series. First, the mechanical design of the HRETR is completed according to the motion characteristics of an elephant’s trunk and based on the principle of mechanical bionic design. After that, the backbone mode method is used to establish the kinematic model of the robot. The simulation software SolidWorks and ADAMS are combined to analyze the kinematic characteristics when the trajectory of the end moving platform of the robot is assigned. With the help of ANSYS, the static stiffness of each component and the whole robot is analyzed. On this basis, the materials of the weak parts of the mechanical structure and the hardware are selected reasonably. Next, the extensible structures of software and hardware control system are constructed according to the modular and hierarchical design criteria. Finally, the prototype is built and its performance is tested. The proposed research provides a method for the design and development for the hyper-redundant bionic robot.

1 Introduction

With the introduction of the concept of Industry 4.0, robots have become more and more essential in intelligent manufacturing [1]. Despite the wide application of robots in the industry [2,3,4,‒5], medical sector [6,7,8,9,‒10], aerospace field [11, 12], and other fields, consumers’ needs are becoming increasingly dynamic and complex [13]. This challenge can be resolved with better motion flexibility, stiffness and load capacity of robots. While traditional robots cannot meet the flexible demands of users, bionic robots can simulate the motion characteristics of elephant’s trunk and octopus tentacles efficiently. Compared with traditional robots, the hyper-redundant bionic robots can accomplish complex tasks in unstructured environments with narrow workspace and numerous obstacles because of their flexible structure [14]. These contemporary robots have attracted the attention of industry experts and researchers [15,16,17,18,‒19].

Having the capability to complete complex tasks in unstructured environments by simulating the motion characteristics of the elephant’s trunk and octopus tentacles, bionic robots can be divided into two categories: (1) Continuous robots are a kind of machines that are driven by flexible and extensible materials such as elastic links and biological muscles [20]. Jones et al. [21] developed a continuous robot driven by both pneumatic and tendon by observing the motion principle of tentacles and elephant’ trunks. The flexible motion control of the robot was achieved based on the new kinematic modeling method. In order to improve the flexibility and adaptability of the robot in an unknown environment, Wang et al. [22] proposed a cable-driven continuous robot. They established its kinematic model and controlled it by a visual servo system. Eventually, Lyapunov theory was used to prove the stability of the control system. Continuous robots can bend continuously like invertebrates and avoid obstacles flexibly. However, the structure construction and the precise position control of such robots are difficult to achieve practically. What’s more, the load capacity of continuous robots is relatively low because of structural limitations. (2) The hyper-redundant robots are a type of robots, which are in series with single-degree-of-freedom driving joints or in series with 2-4-degree-of-freedom parallel mechanism unit modules [23]. Transeth et al. [24, 25] studied the obstacle-crossing gait of snakes and developed a snake-like robot Aiko with high flexibility and adaptability. This robot can survey many unknown and complex terrains and can carry out rescue missions in the rubble. Gallardo et al. [26] developed an open-structured hyper-redundant robot with a 3-DOF parallel mechanism as a unit module. Screw theory was employed to analyze the kinematics of this robot. Finally, a 30-DOF robot was used as an example to show that this robot has good motion performance. Taherifaret [27] proposed a hyper-redundant elephant’s trunk robot driven by a hydraulic system. The robot realizes the motion of the end moving platform through the control of the hydraulic valve, which has the advantages of high stiffness and strong load capacity. Generally, the flexibility of hyper-redundant robots is not as efficient as that of continuous robots. However, because of rigid rods and motors, hyper-redundant robots have better stiffness and load capacity, and they are easier to achieve accurate position control when accomplishing complex operational tasks in the unstructured environment with narrow workspace and numerous obstacles. Especially in the ocean environment, the buoyancy of seawater counteracts gravity effect of the robot to a certain extent, the dynamic performance of these kinds of robots can be better, so the hyper-redundant robots have broad application prospects in the ocean monitoring, deep-sea exploration and other fields. The motivation of the paper is to present the development of the HRETR with an open structure including mechanical structure design, kinematic analysis, virtual prototype simulation, control system design, and prototype building.

In this paper, a HRETR with an open structure, which is composed of six 3UPS-PS parallel mechanism unit modules in series, is built based on the principle of mechanical bionics and based on the special structure characteristics and motion mechanism of an elephant’s trunk muscle group. The main content in this paper includes the overall conception, mechanism design, kinematic model, virtual prototype, control system, physical prototype construction, and performance testing. The rest of this paper is arranged as follows. In Section 2, the mechanical structure design and the overall configuration layout are introduced. In Section 3, the kinematic modeling method of the robot is elaborated. In Section 4, virtual prototype technology is used to carry out the dynamic and static stiffness analysis of the robot. In Section 5, the design of software and hardware of the control system is presented. In Section 6, the construction and performance test of the prototype are introduced, and the performance of the prototype is summarized. Finally, the conclusion is drawn in Section 7.

2 Mechanical Structure Design

The hyper-redundant elephant’s trunk robot is based on the analysis of the external shape and the motion mechanism of an elephant’s trunk. The hyper-redundant robot is applied to imitate the motion characteristics of an elephant’s trunk. Therefore, the structural design of the HRETR mainly includes two sections: the overall configuration layout and the structural design of the unit module. Both determine the number of modules according to the connection mode of each unit module and functional requirements.

2.1 Mechanical Structure Design of the Unit Module

Elephants can grasp things flexibly with their trunk, which can achieve various irregular bending forms. A small segment of an elephant’s trunk is taken as the research object. The cartilage and muscle tissues are distributed around the two expiratory holes. The trunk can move axially and bend radially by contracting the cartilage and muscle. The larger plane of the small segment will represent the reference plane. With the smaller one regarded as the moving plane and the center normal vector of the reference plane regarded as the z-axis, the coordinate system is established. The motion plane can move along the z-axis and rotate around three coordinate axes within a certain range. The motion schematic diagram is shown in Figure 1.

Figure 1

Posture of elephant’s trunk

According to the physiological and motion characteristics of an elephant’s trunk, a 3UPS-PS parallel mechanism (see Figure 2) is designed to complete the three-dimensional rotation and one-dimensional movement of the small segment of an elephant’s trunk. Taking 3UPS-PS parallel mechanism as a unit module has the advantages of high stiffness and high load-weight ratio [28,29,‒30]. The mechanism consists of a moving platform, a base platform, and four motion limbs. The central limb is PS limb and three external limbs are UPS limb. Here, the U, P, and S denote universal, prismatic, and spherical joints, respectively, and the underline denotes the driving joint. The moving platform of the parallel mechanism can perform three-dimensional rotation and one-dimensional movement within a certain range by changing the length of the four driving limbs, which corresponds to the four motion forms of an elephant’s trunk. Drive mode adopts the servo-electric cylinder.

Figure 2

3UPS-PS unit module

2.2 Integral Configuration Design of the HRETR

The overall configuration of the HRETR comprises several 3UPS-PS parallel mechanism modules in series based on the research and analysis of the structural characteristics, motion mechanism of an elephant’s trunk, and the principle of miniaturization and lightweight. A 7-point coplanar design criterion (the rotating centers of spherical joints of the former unit module are coplanar with the rotating center of the universal joint of the latter unit module) is adopted for the convenience of kinematics and dynamics modeling. The connecting mode of the unit modules is in the form of staggered 60 degrees between the head and the tail to avoid mutual interference (Figure 3) in order to realize a 360-degree rotation of the moving platform of the HRETR. Besides, six 3UPS-PS parallel mechanism modules are connected in series according to engineering practice experience and considering the constraint of the rotation angle of the spherical joint (±35°). The size of the HRETR decreases accordingly.

Figure 3

Integral configuration of HRETR

3 Kinematic Analysis of the HRETR

3.1 Position Analysis of the HRETR

3.1.1 Spatial Backbone Curve

The basic idea of the backbone modal method is based on differential geometry theory [12]. The mode equation of the curve is constructed by mode sub-function and mode parameters.

The expression of the spatial curve is shown in Eq. (1). The integral form of the whole center line of the HRETR is described by the backbone modal method.

$$ {\varvec{P}}(s) = \int_{0}^{s} {L{{\varvec{\kappa}}}\left( s \right) \,{\text{d}}s} , $$

(1)

where ${s} \in [0,1]$, L denotes the arc length of the curve, ${{\varvec{\kappa}}}(s)$ represents the tangential vector of the spatial curve at s, $\alpha (s)$ denotes the angle between the y-axis and the projection of the vector ${{\varvec{\kappa}}}(s)$ projecting on the $x_{k} O_{k} y_{k}$ plane, and $\beta (s)$ denotes the angle between the ${{\varvec{\kappa}}}(s)$ and the $x_{k} O_{k} y_{k}$ plane. According to Figure 4, Eq. (1) can be expanded as:

$$ {\varvec{p}}(s) = \left[ \begin{gathered} \int_{0}^{s} {L\sin \alpha (s)\cos \beta (s){\text{ds}}} \hfill \\ \int_{0}^{s} {L\cos \alpha (s)\cos \beta (s){\text{ds}}} \hfill \\ \int_{0}^{s} {L\sin \beta (s){\text{ds}}} \hfill \\ \end{gathered} \right] $$

(2)

Figure 4

Parameterization of ${{\varvec{\upkappa}}}(s)$,$\alpha (s)$, and $\beta (s)$

Based on the mode function, $\alpha (s)$ and $\beta (s)$ can be parameterized as follows:

$$ \left\{ \begin{gathered} \alpha (s) = \sum\limits_{i = 1}^{{n_{1} }} {a_{i} f_{i} (s)} + \sum\limits_{i = 1}^{2} {b_{i\alpha } g_{i} (s)} , \hfill \\ \beta (s) = \sum\limits_{{i = n_{1} + 1}}^{{n_{2} }} {a_{i} f_{i} (s)} + \sum\limits_{i = 1}^{2} {b_{i\beta } g_{i} (s)} , \hfill \\ \end{gathered} \right. $$

(3)

where $a_{i}$ denotes the mode synergetic parameter, $n_{1}$ refers to the number of the modal function related to $\alpha (s)$, $n_{2}$ represents the total number of the modal function, $b_{ia}$ and $b_{i\beta }$ denote the auxiliary control parameters of the orientation angle, $f_{i} (s)$ is the modal sub-function, and $g_{i} (s)$ is the auxiliary orientation control function of the orientation angle of the backbone curve. Generally, functions $g_{i} (s)$ and $f_{i} (s)$ can usually be initialized as $f_{1} (s)\,=\,s,$ $f_{2} (s)\,=\, 1,$ $f_{3} (s)\,= \,s,$ $f_{4} (s)\,=\,\sin (2{\uppi }s),$ $g_{1} (s){ = }1 - \sin ({\uppi }s/2),$ and $g_{1} (s){ = }\sin ({\uppi }s/2).$ The configuration of the backbone is restricted by at least 3 linearly independent modal functions because the endpoint of the spatial curve is with three-dimensional geometric constraints. The initial modal function can be defined as:

$$ \left\{ \begin{gathered} \alpha (s) = a_{1} s + a_{2} + b_{1\alpha } \left[ {1 - \sin ({\uppi }s/2)} \right] + b_{2\alpha } \sin ({\uppi }s/2), \hfill \\ \beta (s) = a_{3} s + a_{4} \sin (2{\uppi }s) + b_{1\beta } \left[ {1 - \sin ({\uppi }s/2)} \right] + b_{2\beta } \sin ({\uppi }s/2). \hfill \\ \end{gathered} \right. $$

(4)

After parameterization, ${\varvec{p}}(s)$ is mainly related to $a_{i}$, $b_{ia}$, and $b_{i\beta }$, and the configurations of the backbone curve can be obtained by the searching parameters $a_{i}$, $b_{2a}$, and $b_{2\beta }$. The iteration approach can be used to search the appropriate control parameters, as given in Eq. (5):

$$ {\varvec{c}}_{m + 1} = {\varvec{c}}_{m} + \lambda {\varvec{J}}_{c}^{ + } ({\varvec{c}}_{m} ,1)({\varvec{v}}_{D} - {\varvec{v}}_{m} (1)), $$

(5)

where ${\varvec{c}}_{m} = \left[ {\begin{array}{*{20}c} {a_{1m} } & {a_{2m} } & {a_{3m} } & {\begin{array}{*{20}c} {a_{4m} } & {b_{2\alpha m} } & {b_{2\beta m} } \\ \end{array} } \\ \end{array} } \right]^{{\text{T}}}$ denotes the position and orientation control parameters of the spatial backbone curve at s, $a_{1m}$, $a_{2m}$, $a_{3m}$, $a_{4m}$, $b_{2\alpha m}$, and $b_{2\beta m}$ denote the value of $a_{1}$, $a_{2}$, $a_{3}$, $a_{4}$, $b_{2\alpha }$, and $b_{2\beta }$ iterating m times respectively,$\lambda$ is a positive constant that controls the convergence of the iterative equation, $\varvec{{v}}_{\text{m}} {(}s{)} = \left[ {\begin{array}{*{20}c} {{\varvec{p}}{(}s{)}^{{\text{T}}} } & {\begin{array}{*{20}c} {\alpha {(}s{)}} & {\beta {(}s{)}} \\ \end{array} } \\ \end{array} } \right]^{{\text{T}}}$ refers to the vector of the position and orientation angle at s, ${\varvec{v}}_{D}$ is the target configuration. ${\varvec{J}}_{c}$ is not a square matrix, ${\varvec{J}}_{c}^{ + }$ is a pseudo-inverse matrix of ${\varvec{J}}_{c}$.

$$ {\varvec{J}}_{c}^{{}} ({\varvec{c}},s) = \frac{{\partial {\varvec{v}}_{m} (s)}}{{\partial {\varvec{c}}_{m} }} = \left[ {\begin{array}{*{20}c} {\frac{{\partial v_{m1} }}{{\partial c_{m1} }}} & {\frac{{\partial v_{m1} }}{{\partial c_{m2} }}} & \cdots & {\frac{{\partial v_{m1} }}{{\partial c_{m6} }}} \\ {\frac{{\partial v_{m2} }}{{\partial c_{m1} }}} & {\frac{{\partial v_{m2} }}{{\partial c_{m2} }}} & {} & {} \\ \vdots & {} & \ddots & {} \\ {\frac{{\partial v_{m5} }}{{\partial c_{m1} }}} & {} & {} & {\frac{{\partial v_{m5} }}{{\partial c_{m6} }}} \\ \end{array} } \right]_{5 \times 6} . $$

(6)

3.1.2 Spatial Backbone Fitting

The spatial backbone curve equation is constructed based on the searched parameters. Searched by dichotomy are the fitting points of the center of the moving platform on the backbone curve of each parallel mechanism module of the HRETR. The variable ${\varvec{p}}_{k}$ denotes the vector from the center of the moving platform of kth parallel mechanism module to the (k−1)th parallel mechanism module. Because the base parallel mechanism module is mounted vertically on the fixed frame, the fitting point of the moving platform position cannot be on the spatial backbone curve, ${\varvec{p}}_{1} = \left[ {\begin{array}{*{20}c} 0 & 0 & { - l_{1} } \\ \end{array} } \right]^{{\text{T}}}$. The length of the ith limb of the kth parallel module need to meet the following requirement:

$$ {\kern 1pt} {\kern 1pt} l_{b,ki} \le q_{ki} \le l_{r,ki} + l_{b,ki} ,{\kern 1pt} {\kern 1pt} {\kern 1pt} (i = 0,1,2,3;\;k = 1,2, \cdots ,n), $$

(7)

where $l_{b,ki}$ and $l_{r,ki}$ denote the length of the sleeve and the push rod of the ith limb, respectively. Also, $\varvec{{L}}_{c}$ represents the length of the middle limb which can be writing as follows:

$$ {\varvec{L}}_{c} = \left[ {\begin{array}{*{20}c} {l_{r,10} } & 0 & {} & 0 \\ 0 & {l_{r,20} } & {} & 0 \\ {} & {} & \ddots & \vdots \\ 0 & 0 & 0 & {l_{r,n0} } \\ \end{array} } \right]{\varvec{H}} + \left[ {\begin{array}{*{20}c} {l_{b,10} } \\ {l_{b,20} } \\ \vdots \\ {l_{b,n0} } \\ \end{array} } \right], $$

(8)

where ${\varvec{H}} = \left[ {\begin{array}{*{20}c} {h_{1} } & {h_{2} } & \cdots & {h_{n} } \\ \end{array} } \right]^{{\text{T}}}$ is the parameters for controlling the length of the middle limbs. In each iteration, the parameter $h_{i}$($i \in (1,n)$) is randomly selected between 0 and 1. When the lengths of other limbs obtained by the inverse displacement of the fitted parallel mechanism module do not satisfy the constraint conditions, the parameter ${\varvec{H}}$ can be adjusted to search again. The variable ${}^{0}{\varvec{R}}_{{O_{k} }}$, which is defined by the Euler angle, denotes the rotation matrix of the moving platform of the kth parallel mechanism module.

$$ {}^{0}{\varvec{R}}_{{O_{k} }} = {\text{Rot}}(y,\phi_{yk} ){\text{Rot}} (x,\phi_{xk} ){\text{Rot}}(z,\phi_{zk} ). $$

(9)

Assuming ${\varvec{n}}_{k} = \left[ {\begin{array}{*{20}c} {n_{k,x} } & {n_{k,y} } & {n_{k,z} } \\ \end{array} } \right]^{{\text{T}}}$ denotes the unit normal vector of the moving platform of the kth parallel mechanism module in the base coordinate system $O_{0} - x_{0} y_{0} z_{0}$. As ${\kern 1pt} {\varvec{n}}_{k}$ is equal to the third column of ${}^{0}{\varvec{R}}_{{O_{k} }}$, it can be obtained as:

$$ \left\{ {\begin{array}{*{20}l} {\phi_{xk} = - \arctan ({{n_{k,y} } \mathord{\left/ {\vphantom {{n_{k,y} } {n_{k,z} }}} \right. \kern-\nulldelimiterspace} {n_{k,z} }}),{\kern 1pt} } \hfill \\ {\phi_{yk} = \arcsin (n_{k,x} ),} \hfill \\ {{\text{if}}{\kern 1pt} {\kern 1pt} n_{k,z} < 0,{\kern 1pt} {\kern 1pt} {\kern 1pt} {\text{let}}{\kern 1pt} {\kern 1pt} \phi_{xk} = \phi_{xk} + {\uppi }{.}{\kern 1pt} } \hfill \\ \end{array} } \right. $$

(10)

Equation (10) is not relevant to $\phi_{zk}$, hence, the target orientation of each parallel module can be pre-set based on a suitable weight.

In sum, the transformation matrix ${}_{k}^{k - 1} {\varvec{T}}$ of the position and orientation of the moving platform, which is relative to the base platform in the kth parallel mechanism module, can be described as:

$$ {}_{k}^{k - 1} {\varvec{T}} = \left[ {\begin{array}{*{20}c} {{}^{{O_{k - 1} }}{\varvec{R}}_{{O_{k} }} } & {{\varvec{p}}_{k} } \\ {0_{1 \times 3} } & 1 \\ \end{array} } \right]. $$

(11)

3.1.3 Inverse Kinematics of the Parallel Mechanism Module

The coordinate systems $O_{k - 1} - x_{k - 1} y_{k - 1} z_{k - 1}$ and $O_{k} - x_{k} y_{k} z_{k}$ are established at the geometric center of the base platform and the moving platform of the kth parallel mechanism module, respectively. The position vector equation of the ith limb of the kth parallel mechanism module is

$$ q_{k0} {\varvec{e}}_{k0} + {}^{{O_{k - 1} }}{\varvec{R}}_{{O_{k} }} {\varvec{b}}_{ki} = {\varvec{a}}_{ki} + q_{ki} {\varvec{e}}_{ki} , $$

(12)

where $i = 1,2,3,$ $k = 1,2,3, \cdots ,n,$ ${\varvec{a}}_{ki}$ denotes the vector from the origin of the coordinate system $O_{k - 1} - x_{k - 1} y_{k - 1} z_{k - 1}$ to the center of the universal joint, ${\varvec{b}}_{ki}$ represents the vector from the origin of the coordinate system $O_{k} - x_{k} y_{k} z_{k}$ to the center of the spherical joint.

3.2 Velocity and Acceleration Analysis of the HRETR

The specific kinematic solution of the HRETR is as follows:

• 1) It involves providing the position and orientation x, y, z, $\phi_{x}$, $\phi_{y}$, and $\phi_{z}$ of the distal moving platform of the HRETR.

• 2) The inverse displacement algorithm of the HRETR based on the spatial backbone curve modal method is used to obtain the position and orientation of the moving platform relative to the base platform of each parallel mechanism module before interpolating the trajectory in the joint space.

• 3) It involves taking the time derivative of the trajectory, linear velocity ${\varvec{v}}_{k}$, angular velocity ${{\varvec{\omega}}}_{{\text{k}}}$, linear acceleration ${\dot{\varvec{v}}}_{{\text{k}}}$, and angular acceleration $\varvec{\dot{{\omega }}}_{{\text{k}}}$ of the moving platform of the kth unit module.

• 4) The kinematics of the HRETR is transformed into that of the unit module. The velocity and acceleration of each limb of the unit module are obtained by the inverse kinematics of the unit module.

  $$ {\dot{\varvec{q}}}_{{{\varvec{ki}}}} { = }\left[ {\begin{array}{*{20}c} {\dot{q}_{k1} } & {\dot{q}_{k2} } & {\dot{q}_{k3} } & {\dot{q}_{k4} } \\ \end{array} } \right]^{{\text{T}}} { = }{\varvec{J}}_{k} \left[ {\begin{array}{*{20}c} v \\ {{\varvec{\omega}}} \\ \end{array} } \right], $$

  (13)
  $$ {\ddot{\varvec{q}}}_{{{\varvec{ki}}}} { = }{\varvec{J}}_{{\text{k}}} \left[ {\begin{array}{*{20}c} {\dot{v}} \\ {{\dot{\varvec{\omega }}}} \\ \end{array} } \right] + {\varvec{U}}, $$

  (14a)
  $$ U_{ki} = q_{ki} \left( {{{\varvec{\omega}}}_{{{\text{ki}}}}^{{\text{T}}} {{\varvec{\omega}}}_{ki} } \right) + \left( {{\varvec{w}}_{ki}^{{\text{T}}} {{\varvec{\omega}}}} \right)\left( {{{\varvec{\omega}}}_{{}}^{{\text{T}}} {\varvec{a}}_{ki} } \right) - \left( {{\varvec{w}}_{ki}^{{\text{T}}} {\varvec{a}}_{ki} } \right)\left( {{{\varvec{\omega}}}^{{\text{T}}} {{\varvec{\omega}}}} \right), $$

  (14b)

where ${\varvec{J}}_{{\text{k}}}$ is the velocity of the Jacobian matrix, ${{\varvec{\omega}}}_{{{\text{ki}}}}$ and ${\varvec{a}}_{ki}$ are the angular velocity of the limb in the basic coordinate system of the unit module and the coordinates of the hinge points of the moving platform, respectively.

The kinematic analysis method of the HRETR is designed according to the content shown in Figure 5.

Figure 5

Kinematic algorithmic flow of the HRETR

4 Virtual Prototype Simulation

In the process of prototype development, the virtual prototype simulation technology of robots can be used in the whole life cycle of product development or system design, which includes feasibility demonstration, technical performance index determination, system design, equipment operation, and maintenance among others.

4.1 Dynamic Analysis of the HRETR

In order to ensure the reliability of the prototype, the dynamic analysis of the robot is carried out with virtual prototype technology before the prototype testing. On the basis of Section 3.1, MATLAB is used to carry out the kinematic simulation. The specific trajectory is shown in Eq. (15), and the trajectory data of each electric cylinder are obtained (Figure 6). The data are imported into the driving joint of the prototype (Figure 7). After the simulation, the displacement, velocity, acceleration and force curve of the driving joint of each unit parallel mechanism module can be obtained as outputs. The simulation results are shown in Figures 8, 9, 10, 11, 12, 13.

$$ \left\{ \begin{gathered} x = (432.6 + f_{1} ({{t}}))\sin (f_{2} ({{t}})) + (329.6 + f_{1} ({{t}}))\sin (2f_{2} ({{t}})) + \hfill \\ \;\;\;\;\;\;(318 + f_{1} ({{t}}))\sin (3f_{2} ({{t}})) + (313 + f_{1} ({{t}}))\sin (4f_2(t) ){ + }(313 + \hfill \\ {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} f_{1} ({{t}}))\sin (5f_2(t) ),\; \hfill \\ y = 0, \hfill \\ z = (432.6 + f_{1} ({{t}})) + (432.6 + f_{1} ({{t}}))\cos (f_{2} ({{t}})) + (329.6 + f_{1} ({{t}})) \hfill \\ {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} \cos (2f_{2} ({{t}})) + (318 + f_{1} ({{t}}))\cos (3f_{2} ({{t}}))\; + \hfill \\ {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} (313 + f_{1} ({{t}}))\cos (4f_{2} ({{t}})){ + }(313 + f_{1} ({{t}}))\cos ({5}f_{2} ({{t}})), \hfill \\ \phi_{x} = 0, \hfill \\ \phi_{y} = 8.48 \times 10^{ - 6} t^{4} - 3.93 \times 10^{ - 7} t^{5} + 4.71 \times 10^{ - 9} t^{6} - 2.44 \times 10^{ - 11} t^{7} , \hfill \\ \phi_{z} = 0, \hfill \\ f_{1} ({{t}}){ = }2.7 \times 10^{ - 5} t^{4} - 1.08 \times 10^{ - 6} t^{5} + 1.5 \times 10^{ - 8} t^{6} - 7.14 \times 10^{ - 11} t^{7} , \hfill \\ f_{2} ({{t}}){ = }1.41 \times 10^{ - 6} t^{4} - 5.66 \times 10^{ - 8} t^{5} + 7.86 \times 10^{ - 10} t^{6} - 3.74 \times 10^{ - 12} t^{7} , \hfill \\ \end{gathered} \right. $$

(15)

Figure 6

Trajectory simulation of HRETR

Figure 7

Virtual prototype

Figure 8

a Displacement, b velocity, c acceleration, and d driving force of each limb of module 1

Figure 9

a Displacement, b velocity, c acceleration, and d driving force of each limb of module 2

Figure 10

a Displacement, b velocity, c acceleration, and d driving force of each limb of module 3

Figure 11

a Displacement, b velocity, c acceleration, and d driving force of each limb of module 4

Figure 12

a Displacement, b velocity, c acceleration, and d driving force of each limb of module 5

Figure 13

a Displacement, b velocity, c acceleration, and d driving force of each limb of module 6

where x, y, z, $\phi_{x}$, $\phi_{{\text{y}}}$, and $\phi_{z}$ denote the position and orientation of the distal moving platform of the HRETR.

By observing the kinematic diagram of Figures 8, 9, 10, 11, 12, 13 the kinematic law of each limb meets the preset requirements (both the initial and terminal velocity and the acceleration are 0). By observing the dynamic diagram of Figures 8, 9, 10, 11, 12, 13, the range of the driving force of each limb in Module 1 and 2 is 0‒3500 N, Module 3 is 0‒2000 N, and Module 4, 5, and 6 is 0‒1500 N. The electric cylinders of each module are selected based on Figures 8, 9, 10, 11, 12, 13. The rated driving force of the selected electric cylinders is shown in Table 1.

Table 1 Rated driving force of the electric cylinder in each module of the HRETR

4.2 Static Stiffness Analysis of the HRETR

In order to ensure that the designed components can meet the stiffness requirements, ANASYS is used to analyze the static stiffness of the HRETR. The results are shown in Figure 14.

Figure 14

Static stiffness analysis of HRETR

The static stiffness of the HRETR is analyzed on some typical configurations by using software ANSYS. The maximum stress that is located on the external hinge of module 3 is 199.87 MPa. Compared with the material and mechanical properties of the key parts (Table 2), it meets the mechanical requirements.

Table 2 Properties of materials in key parts

5 Control System Design

The control system is divided into hardware design and software design. The design of the software and hardware follows the principle of hierarchical and modular design. Based on the established overall framework, the control system is divided into different modules according to its functions. This design principle facilitates subsequent maintenance and upgrading.

5.1 Software Design of the Control system

5.1.1 Integral Structure Design of Software of the Control System

The aim of the control system of the HRETR mainly aims is to simulate a movement like an elephant’s trunk. In the process of the motion, the control system needs to have a reliable kinematic calculation and trajectory planning interpolation algorithm, and it also needs to monitor the state of the real-time motion via a friendly control interface. At the same time, the design of the control system software of the HRETR needs to consider the extensibility of structure of the robot in order to meet different working requirements. This software system adopts the modular design method. From the human-computer interaction interface to the hardware driver, the system is divided into four-fold: application layer, function layer, execution layer, and driver layer. The overall control architecture is shown in Figure 15.

Figure 15

Software of the control system of the HRETR

5.1.2 Control Interface

The control interface is between the user and the robot control system. Most of the content of the robot is displayed on the control interface, thus providing the user with a concise and intuitive operation environment. Figure 16 shows the main interface of the control interface, which is composed of several modules. The main interface is used to display the current three-dimensional position and the orientation information of the robot, to query the current status of each mechanism parallel module, to record and display the user's operation and the running status of the system in real time, and to save the information in the log file. At the same time, it also includes the control system’s function buttons, which control the motion planning, return home, parameter setting, starting, suspending, and exiting. The motion planning interface is shown in Figure 17. It can set up the motion planning parameters of the HRETR, including point motion, motion interpolation, and obstacle avoidance planning. The state monitoring and setting interface of the mechanism module is shown in Figure 18. It can monitor the status of each axis of the mechanism module, including the actual position, the planning position, the actual velocity, the planning velocity, and the planning acceleration.

Figure 16

Main interface of PC control software for HRETR

Figure 17

Interface of motion planning for HRETR

Figure 18

Status monitoring of parallel mechanism module

5.2 Hardware Design of the Control System

The HRETR adopts the extensible hardware system platform of IPC + multi-motion control card. The hardware structure of the system is shown in Figure 19. In order to meet the interchangeability of the hardware system structure, the system hardware is divided into the industrial computer, the motion module, the servo drive module, the controller, the servo system module, and other main modules. These modules have relatively independent functions, and users can replace them based on their needs. The virtual prototype technology is used to simulate the motion of the prototype. The estimated parameters of important performance indexes such as rated torque and rated velocity of the servo motor are obtained in conjunction with the dynamic analysis in the virtual environment. The type of selected hardware of the control system is shown in Table 3.

Figure 19

Hardware structure of the control system of HRETR

Table 3 Parameters of control system hardware

6 Prototype Building

The prototype construction is the last stage in the development of the HRETR. It involves the problems of processing technology and engineering technology. In the construction process, the steps of installation, debugging, and operation need to be arranged properly and carried out orderly to minimize hazards and ensure personal safety. In order to improve the assembly efficiency, the virtual prototype is simulated in SolidWorks to provide support for the assembly of the physical prototype. Also, the software must be installed efficiently and sequentially. The steps of building the physical prototype are shown in Figure 20.

Figure 20

Installation steps of HRETR

It is necessary to test the performance of the prototype when the prototype is built. Before testing, it is necessary to import the control data obtained from the kinematic model into the virtual prototype to observe whether there is a sudden change in the force of each limb in the motion process and whether the motion is stable. The testing process should be gradual. After the debugging process, the performance of each module is tested by letting the HRETR operate according to the given trajectory shown in Figures 21, 22, 23, 24, 25, 26. The results show that the robot can bend like an elephant’s trunk in a wide range. Table 4 shows the motion performance of the HRETR.

Figure 21

100° bending configuration of HRETR

Figure 22

180° bending configuration of HRETR

Figure 23

S configuration of HRETR

Figure 24

100° bending configuration of HRETR

Figure 25

180° bending configuration of HRETR

Figure 26

S configuration of HRETR

Table 4 Performance parameters of the HRETR

7 Conclusions

In this paper, a prototype of a HRETR with expansibility is designed based on the principle of mechanical bionics while considering the special structure and movement mechanism of an elephant’s trunk muscle group. A summary can be drawn as follows:

• (1) Based on the principle of bionic design, a HRETR with an open structure which is composed of six modules of 3UPS-PS parallel mechanism in series is designed. Using the spatial backbone modal method, the kinematic model of this robot is established. The dynamic and the static stiffness of the robot are analyzed with virtual prototype technology, which provides the basis for the refinement of the structure, the selection of the prototype material and the electric cylinder.

• (2) According to the structural characteristics of the HRETR, an extensible software and hardware control system is constructed according to the modular and hierarchical design criteria, a construction method that fully maximizes the potential extensibility of the HRETR.

• (3) The performance of the prototype is tested and it is shown that the HRETR can realize the functions of bending like an elephant’s trunk. This finding verifies the rationality and feasibility of the mechanical structure design and control method of the robot.