Skip to main content

ORIGINAL RESEARCH article

Front. Robot. AI, 03 May 2021
Sec. Computational Intelligence in Robotics
This article is part of the Research Topic Biological and Robotic Inter-Limb Coordination View all 23 articles

Unified Approach to the Motion Design for a Snake Robot Negotiating Complicated Pipe Structures

  • 1Department of Mechanical Engineering and Science, Graduate School of Engineering, Kyoto University, Kyoto, Japan
  • 2Department of Mechanical and Intelligent Systems Engineering, The University of Electro-Communications, Tokyo, Japan

A unified method for designing the motion of a snake robot negotiating complicated pipe structures is presented. Such robots moving inside pipes must deal with various “obstacles,” such as junctions, bends, diameter changes, shears, and blockages. To surmount these obstacles, we propose a method that enables the robot to adapt to multiple pipe structures in a unified way. This method also applies to motion that is necessary to pass between the inside and the outside of a pipe. We designed the target form of the snake robot using two helices connected by an arbitrary shape. This method can be applied to various obstacles by designing a part of the target form specifically for given obstacles. The robot negotiates obstacles under shift control by employing a rolling motion. Considering the slip between the robot and the pipe, the model expands the method to cover cases where two helices have different properties. We demonstrated the effectiveness of the proposed method in various experiments.

1. Introduction

Despite their simple body configuration and lack of limbs, biological snakes move in a wide variety of environments, such as sandy and muddy places, in trees, and in narrow spaces. Inspired by biological snakes, snake robots with simple structures formed from repeating connecting modules have been developed and can perform various kinds of locomotion. They are expected to be used in dangerous situations, such as rescue work and infrastructure inspections, especially when spaces are narrow and inaccessible to humans, such as inside pipes. Controlling snake robots is a challenge because of their redundancy, and much research has been conducted to overcome this difficulty. The research that apply the motion observed in biological snakes, such as the undulation on the plane (Hirose, 1987) and the locomotion utilizing obstacles (Kano et al., 2018) into the engineering control of the snake robot has been done. Not only the motion but also the nervous system of biological snakes is utilized as the Central Pattern Generator (CPG) (Crespi and Ijspeert, 2008; Wu and Ma, 2013; Sartoretti et al., 2019).

Model-based control approach has also been studied. Several control methods have been developed that aid the convergence of control values toward reference values in modeling the interaction with snake robots and environments. These methods can be separated into two approaches. One considers the sideslip of the robot body (Saito et al., 2002; Mohammadi et al., 2015; Ariizumi et al., 2018), and the other considers non-holonomic constraints without sideslip (Matsuno and Sato, 2005; Tanaka et al., 2015; Nakajima et al., 2019). These methods have the advantages of simple environments and essentially planar surfaces but are unsuitable for complex or unknown environments because it is difficult to construct the dynamic model including the interaction with such environments.

To fulfill locomotion in such complicated environments for modeling, various designs of the whole form of the robot for effective locomotion have been proposed. These methods without modeling are beneficial in challenging environments, such as in narrow spaces and pipes in which the robot makes multiple points of contact along its length. Several gaits, e.g., lateral rolling and pipe crawling, have been realized by formulating a trajectory of joint angles as a gait function and changing several gait parameters that possess clear physical characteristics (Tesch et al., 2009; Rollinson and Choset, 2016). For complicated target forms for a snake robot, however, this approach is not feasible because it is difficult to formulate target joint angles directly.

To realize locomotion based on more complex target curves, methods of designing gaits by fitting a snake robot configuration to a target curve, which is designed as a continuous curve, have been proposed (Yamada and Hirose, 2006, 2008; Andersson, 2008; Hatton and Choset, 2010; Liljebäck et al., 2014). These methods make it possible to consider snake robot configurations as continuous curves, thus making it easy to design complicated forms. Takemori et al. (2018a) expanded Yamada's method (Yamada and Hirose, 2006) and proposed a method involving the design of a target curve by connecting simple shapes. They used their proposed method to design a target form that required the robot to partially lift the body around a flange on a pipe and achieved movement over the flange. Movements over rough terrain and climbing up ladders (Takemori et al., 2018b) were also accomplished.

The research of the snake robot moving inside a pipe is on the way to the final goal of our research that is to be able to perform pipe inspections with snake robots. As shown in Figure 1A, there are likely to be many “obstacles” that a robot moving inside pipes will have to navigate, including junctions, bends, continuous and discontinuous changes in pipe diameter, shears, and blockages. Some of these obstacles, such as bends, junctions, and continuous changes in pipe diameter are overcome with the previous methods (Kamegawa et al., 2011; Rollinson and Choset, 2016), whereas it has been difficult to deal with discontinuous diameter changes, shears, and blockages. Also, the robot is likely to encounter various kinds of obstacles one after another in an actual pipeline system. Since previous methods are designed only for an individual obstacle, many different methods are needed to deal with many kinds of obstacles serially. However, it is impractical to seamlessly switch between disparate control methods depending on the obstacle.

FIGURE 1
www.frontiersin.org

Figure 1. Concept of the research. (A) Various pipe structures. (B) Structure of a snake robot. (C) Definition of ψ(s).

To get one step closer to the final goal, we address the negotiation of the complicated pipe structures in this paper. We propose a “unified” method that enables a snake robot to deal with all obstacles in Figure 1A, some of which have not yet been overcome and the others of which have already been overcome, just by altering the target form of the robot partially depending on the obstacle. Consequently, we can realize the motion control which serially negotiates various obstacles without switching to another method. In this method, the snake robot negotiates an obstacle by locally conforming to the shape of the obstacle while propelling itself forward through the pipe with a rolling motion. This method is improved by adjusting the rolling motion while considering the slip between the robot and a pipe, so as to make the method applicable to motion that includes two helices having different radii and pitches. Furthermore, this method creates a novel motion for entering and exiting a pipe. The entire motion of the robot is conducted remotely by an operator using simple inputs. We also demonstrate this unified motion, which is applicable to complicated pipe structures, to design target forms for junctions, bends, changes in pipe diameter, shears, blockages, and the inside-out motion as examples of its application. We also conduct experiments using this unified motion.

This research is based on Inazawa et al. (2020) and expands it by adding a model that considers the slip between pipe and robot in order to negotiate a change in diameter and to move from inside to outside a pipe. Finally, we carry out these experiments to verify the model.

2. Previous Work

This section introduces the previous work mentioned in section 1 in detail.

2.1. Approximation to a Continuous Curve

Methods for calculating the joint angles of the snake robot to approximate to a continuous curve were proposed in Yamada and Hirose (2006, 2008), Andersson (2008), Hatton and Choset (2010), and Liljebäck et al. (2014). Andersson (2008) proposed a method of fitting each joint to a target curve from head to tail for an articulated robot with universal joints. Hatton and Choset (2010) proposed annealed chain fitting, where approximation was conducted from a head by minimizing a cost function about the distance between each joint and a target curve. Liljebäck et al. (2014) proposed a method of fitting to a continuous curve generated by connecting points in three-dimensional space. Yamada and Hirose (2008) modeled a target curve for a snake robot (Yamada and Hirose, 2006) and proposed a method of obtaining a target angle for each joint by the curvature and torsion of the curve (Yamada and Hirose, 2008).

This Yamada's method can be applied to a robot with any joint configuration and is computationally inexpensive. Various gaits employing this method have been proposed (Kamegawa et al., 2009, 2011; Baba et al., 2010; Zhen et al., 2015; Zhou et al., 2017; Qi et al., 2018; Yaqub et al., 2019). Kamegawa et al. designed a helical target form and proposed helical rolling motion for moving on a pipe (Kamegawa et al., 2009; Baba et al., 2010). They also proposed a helical wave propagation motion (Qi et al., 2018) to negotiate a branch on the pipe. By sending a waveform down the helix, this motion enabled movement in the tangential direction of the helix, which a rolling motion cannot realize. Zhen et al. (2015) designed a curve superimposing a hump onto an arc and proposed a rolling hump that enables movement over obstacles using a rolling motion. Zhou et al. (2017) designed a target form including two helices and a connecting curve; by expanding and contracting like a spring, the robot achieved a movement outside a pipe with a changing diameter. Yaqub et al. (2019) designed a spiral curve having a gradually changing diameter, which enables the snake robot to move outside a pipe with a discontinuous change in diameter.

When a target curve becomes more complicated, it is difficult to express the spatial curve analytically. Also, the target joint angle cannot be calculated with Yamada's method (Yamada and Hirose, 2008) when torsion at a point diverges as the curvature is zero (Yamada and Hirose, 2006). To solve these problems, Takemori et al. (2018a) expanded Yamada's method (Yamada and Hirose, 2006) and proposed a method to design a target curve by connecting simple shapes, such as straight lines, circular arcs, and helices. This method enables an intuitive design of connecting shapes with familiar properties. Also, there is no need to calculate the curvature or torsion of a curve that is already known.

2.2. Motion Inside a Complicated Pipe

Rollinson and Choset (2016) proposed a method of compliance control in which the present form of the robot can be estimated from the joint angles using an extended Kalman filter based on gait parameters. This enabled semi-autonomous adaptation to a changing environment and locomotion inside pipes having bends, junctions, and continuous changes in diameter. This method is thought to be difficult to apply to great and discontinuous changes in diameter because the whole part of the robot winds around the pipe. Kamegawa et al. (2011) designed a target form by connecting a bending helical curve (Kamegawa et al., 2011) to a helix and realized movement inside a pipe with a bend. Some improvement is needed before these methods can be applied to shears and blockages, which require the robot to conform to obstacles elaborately.

3. Gait Design and Fitting Method

3.1. Shape Fitting Using a Backbone Curve

The snake robot in this study consists of alternating connected pitch-axis and yaw-axis joints, as shown in Figure 1B. The link length is l, and the relative angle of the i-th joint is θi.

To start, we explain the approximation method with which we configure the snake robot to a target form (Yamada and Hirose, 2008). We begin with the representation of a spatial curve based on curvature and torsion. Let us consider the Frenet–Serret frame, which is an orthonormal basis (e1(s), e2(s), e3(s)) that depends on a single parameter s associated with the length along the curve. Moreover, e1(s) is a vector tangential to the curve, e2(s) is an inward vector normal to the curve, and e3(s) is defined as e1(s) × e2(s). That is, the frame depends on the form of the curve. In addition, we need to consider the coordinate system that provides the orientation of the snake robot. We establish a backbone reference frame (er(s),ep(s),ey(s)) on the curve. er(s) is the same vector as e1(s), whereas ep(s) and ey(s) are vectors in the direction of the pitch-axis and yaw-axis, respectively.

As in Figure 1C, ψ(s) is defined as the twist angle between the Frenet–Serret frame and the backbone reference frame around e1(s) and expressed by torsion τ(s) as

ψ(s)=0sτ(s^)ds^+ψ0,    (1)

where ψ0 is an arbitrary constant of integration corresponding to the initial value of the twist angle. Changing ψ0 rotates the backbone reference frame around the curve and generates the rolling motion. The curvature around the pitch-axis and yaw-axis, denoted by κp(s) and κy(s), respectively, are expressible in terms of curvature κ(s) and ψ(s) as follows:

κp(s)=-κ(s)sinψ(s),κy(s)=κ(s)cosψ(s).    (2)

Finally, we obtain the target angle of each joint as

θid={sh-(i+1)lsh-(i-1)lκp(s)ds(i:odd)sh-(i+1)lsh-(i-1)lκy(s)ds(i:even),    (3)

where sh is the head position of the snake robot on the target curve. The robot transforms itself smoothly under shift control, by which the change in sh shifts the range corresponding to the robot's body within a target curve.

3.2. Backbone Curve Connecting Simple Shapes

Next, we explain the method of representing the target form as connected simple shapes for which the curvature and torsion are constant, such as straight lines, circular arcs, and helices (Takemori et al., 2018a). This method expands Yamada's method (Yamada and Hirose, 2008) to address the Frenet–Serret frames that are discontinuous at connection-parts, where simple shapes are brought together.

A connected simple shape is called a segment, and the j-th segment is referred to as segment-j(j ∈ ℤ). The connection-part between segment-j and segment-(j + 1) is referred to as connection-part-j at point s = sj. Points infinitesimally before and after the connection-part-j are denoted by sj and sj+, respectively. The curvature and torsion of segment-j are represented as κj and τj, respectively. Using κj and τj, the curvature κ(s) and torsion τ(s) of the target curve at sj−1 < ssj, which is equivalent to the point on segment-j within the connected segments, are defined as

κ(s)=κj(s-sj-1), τ(s)=τj(s-sj-1)     (sj-1<ssj).    (4)

Let us next consider twists at the connection-part. The twist angle between e2(sj) and e2(sj+) around e1(sj) is denoted by ψ^j. To incorporate this twist angle into the calculation of shape fitting, (1) is replaced by

ψ(s)=0sτ(s^)ds^+ψ0+jψ^ju(s-sj),    (5)

where u(s) is the step function, for which its value is 0 if s < 0 and 1 if s ≥ 0.

In this study, we use straight lines, circular arcs, and helices as segments. For a straight line, the Frenet–Serret frame and the torsion cannot be determined; in this instance, we define the torsion as 0. An arc has a constant curvature and zero torsion and is defined by its radius rj and central angle ϕj. A helix has curvature and torsion that are both non-zero and constant and is defined by its radius aj, bj, and central angle ϕj. Here, bj = pj/2π is satisfied, where pj is the pitch of the helix. Let us call the angle between the tangent of the helix and the plane perpendicular to the axis of the helix the lead angle, expressed as α = arctan(pj/2πrj). On the helix, e2(s) is a vector directed vertically from the helix to the axis of the helix.

3.3. Shape Constraints

We consider the shape constraints for a target form resulting from the limits imposed on the joint angles. The maximum bending angle of a joint is represented as θmax. Whereas it is difficult to consider constraints in all states, here we only consider instances where the integration range in (3) includes separately only a circular arc and only a helix.

For the first instance, we let κc denote the curvature of the circular arc. From (3), the condition imposed to limit the target joint angle is given by

|θid|={|sh(i+1)lsh(i1)lκ(s) sinψ(s)ds|(i:odd)|sh(i+1)lsh(i1)lκ(s) cos ψ(s)ds|(i:even)llκcds=2lκcθmax.    (6)

In the second instance, the curvature and torsion of the helix is denoted by κh and τh, respectively. By substituting these into (5), ψ(s) is represented as

ψ(s)=τhs+ψ0.    (7)

Substituting this into (2), the equation is represented as

κp(s)=-κhsin(τhs+ψ0),κy(s)=κhcos(τhs+ψ0).    (8)

By substituting these into (3), the condition limiting the target joint angle is expressed as,

|θid|={|sh(i+1)lsh(i1)lκh sin (τhs+ψ0)ds|(i:odd)|sh(i+1)lsh(i1)lκh cos (τhs+ψ0)ds|(i:even) max[|llκh sin (τhs¯+x)ds¯|(0x<2π)] =max[2|κhτh sin (τhl) sin (x)|(0x<2π)] 2|κhτh sin (τhl)|θmax,    (9)

where

s̄=s-(sh-il),    (10)
x=τh(sh-il)+ψ0.    (11)

4. Motion Design

We now discuss the target form of the proposed motion. As shown in Figure 2A, the target form consists of two helices on straight pipes, called the head winding part near the head and the tail winding part near the tail; an axis for each winding part, called the head axis and tail axis; a guiding part from each winding part to its respective axis, called the head guiding part and tail guiding part; and a dodging part, which connects two guiding parts and dodges obstacles. Tailoring this dodging part to obstacles enables the robot to adapt to various obstacles. The robot negotiates an obstacle under shift control while moving its whole body from the tail winding part to the head winding part.

FIGURE 2
www.frontiersin.org

Figure 2. (A) Configuration of the target form for a snake robot negotiating a pipe. (B) Comparison between models with and without guiding parts. The black dotted ellipses represent the ends of the dodging part.

We mention the purpose of guiding each end of the dodging part from the winding part to its axis. First, consider an instance where each end of the dodging part (black dotted ellipse) is not on the axis of a pipe, as shown in the left panel of the Figure 2B. Although discussed in detail in section 4.2.1, here we remark that each winding part rotates around its axis according to commands from the shift control, and the relative position of the two end points of the dodging part changes. It is difficult to deform the dodging part (blue line) adequately in response to this change in the relative position of two end points. To solve this, we design guiding parts to guide each end of the dodging part (black dotted ellipse) onto each axis. Although each guiding part rotates around its axis, the relative position of the two ends of the dodging part no longer changes as shown in the right panel of Figure 2B. Therefore, the dodging part (blue line) easily adapts to an obstacle without deforming itself.

The winding and guiding parts are designed independently of an obstacle, whereas the dodging part is designed for it. In the following sections, we discuss the form design and the movement to realize the motion described above.

4.1. Form Design

We discuss the design of common parts regardless of obstacles. The parameters for these parts are shown in Table 1. We continue to describe each of these parts.

TABLE 1
www.frontiersin.org

Table 1. Parameters describing segments that compose the form for pipe negotiation.

4.1.1. Winding Part

The radius of the tail winding part trw is given by (tdpipe/2) − rlink, where tdpipe is the inner diameter of the pipe on the tail side and rlink is the link radius of the snake robot. The pitch of the tail winding part tpw is designed along with the tail guiding part, to which we turn next. The tail winding part is designed to be long enough to cover the whole body of the robot. Using the equation to obtain the length of the helix, the central angle of the tail winding part tβw is determined to satisfy

lrobotl1=βtwrtw2+(ptw2π)2,    (12)

where lrobot is the total length of the snake robot. The radius, pitch, and central angle of the head winding part are denoted by hrw, hpw, and hβw, respectively, and defined in a similar way to those of the tail winding part.

4.1.2. Guiding Part

Figure 3A shows the segment configuration of the guiding parts. In Table 1, nd is the number of segments comprising the dodging part. The head and tail guiding parts have similar shapes and parameters depending on the head and tail winding parts, respectively. For this reason, we treat only the tail guiding part, whose shape is determined by tpw, the radius of segment-2 trin, and the radius of segment-4 rc.

FIGURE 3
www.frontiersin.org

Figure 3. (A) Segment configuration of the guiding parts. (B) Schematic of the tail guiding part on the xy plane. (C) Schematic of the tail guiding part on the xz plane.

A projection of the tail guiding part onto the xy plane in the absolute coordinate system Oxyz, where the z axis is equivalent to the axis of the pipe, is shown in Figure 3B. The points P, Q, R, Ow on the top of the figure are the connection-parts and have corresponding points on the bottom of the figure. Ow represents the center point of the gray circle in Figure 3B, which is the projection of segment-1 on the xy plane. Segment-2 is a helix, which changes the direction of the target curve toward the tail axis. The axis of segment-2 is designed to be parallel to the tail axis in order to simplify the geometrical calculation by turning all helices into a circle and an arc on the xy plane, as in Figure 3B. Oin represents the center point of the red circular arc in Figure 3B, which is the projection of segment-2 on the xy plane.

To realize this segment configuration, tpin and tβin, and tls are determined after the following calculation. Since segment-1 and segment-2 are connected continuously, the angle between the xy plane and the target curve at connection-part-1 is equal to the lead angle of segment-1. If the lead angle of segment-2 is equal to that of segment-1, the axis of segment-2 is perpendicular to the xy plane and parallel to that of segment-1. To ensure that the axes of segment-2 and the tail winding part are parallel to each other, the lead angle tα must satisfy

αt=arctanptw2πrtw=arctanptin2πrtin.    (13)

Then, we obtain tpin as

ptin=rtinrtwptw.    (14)

A projection of the tail guiding part onto the xz plane is also shown in Figure 3C. The points P, Q, R, Ow on the top of the figure are the connection-parts and have corresponding points on the bottom of the figure. Oc represents the center point of the green circular arc in Figure 3C, which is the projection of segment-4 on the xz plane. tβin is derived by the geometric relationship shown in Figure 3B as

βtin=OinQOw+OinOwQ=π2+arcsinrtinrtwrtin.    (15)

To obtain tls, we firstly derive OwR and RQ in Figure 3B by the geometric relationship shown in Figure 3C as

RQ=tlscostα,    (16)
OwR=rc{1-cos(π2-tα)}.    (17)

Then, tls is given by (16), (17), and the geometric relationship shown in Figure 3B as

lts=RQcostα=OwQOwRcostα =(rtwrtin)2rtin2rc{1cos(π2αt)}costα.    (18)

Note that tpw and trin should be determined while satisfying tls ≥ 0 for this segment configuration. In addition, the shape constraints described in section 3.3 also should be satisfied.

We introduce a parameter, ϕoffset, that is tuned by an operator and used to adjust the direction of the dodging part appropriately to the shape of the pipe.

4.1.3. Dodging Part

The dodging part can be designed for a specific pipe structure. Section 5 provides examples relevant to a junction, bend, shear, blockage, and change in pipe diameter.

4.2. Procedure of Movement

We next explain the movement for the proposed motion. Figure 4 shows the procedural steps involved in negotiating an obstacle. Here, we use the target form for the junction presented in section 5. The four steps in Figure 4 are described as follows:

1. Step 1: Approach the obstacle using a rolling motion (rolling angle).

2. Step 2: Shift the head position to the dodging part under shift control (shift length).

3. Step 3: Adjust the position of the dodging part in the axial direction with a rolling motion and the direction using ϕoffset (rolling angle and ϕoffset).

4. Step 4: Negotiate the obstacle under shift control (shift length).

FIGURE 4
www.frontiersin.org

Figure 4. Procedure involved in movement.

Here, an operator commands the value in parentheses in each step. The operator can recognize the dodging part with Step 2 and adjust its position and direction with Step 3. The appropriate position and direction of the dodging part in Step 3 are different for each obstacle, as described in section 5.

4.2.1. Fixing of Dodging Part

The position of the dodging part should be fixed to an environment while the robot is negotiating the pipe without colliding with the pipe in Step 4. The following figures illustrate instances for a junction. Here, no slip is assumed between the robot and pipe.

First, consider the displacement in the axial direction. As shown in the left panel of Figure 5A, just executing a shift control leads to the collapse of the target form because of the displacement of the dodging part in the axial direction. Therefore, this displacement caused by the shift control is canceled with a rolling motion, as shown in the right panel of Figure 5A. To this end, as shown in Figure 5B, the rolling velocity at connection-part-1 ψtroll is determined by the velocity of the shift control ṡh,

ψ˙troll=s˙hsintαktaxis,    (19)

where tkaxis is the displacement in the axial direction per unit rolling angle.

FIGURE 5
www.frontiersin.org

Figure 5. Fixing the dodging part. (A) Shift control executing rolling motion. (B) Displacement of the tail axis at connection-part-1. (C) Adjustment of the torsion angle. (D) Definition of tϕrot. (E) Rotation around the tail axis at connection-part-1.

Second, consider the rotation around the axis. The rotation of the dodging part also breaks the target form because the direction of the dodging part becomes ill suited to the obstacle, as shown in Figure 5C. tϕrot, the term in ψ^4 in Table 1, is changed so as to cancel out the rotation of the dodging part (see Figure 5D). For this purpose, as shown in Figure 5E, ϕtrot, the time derivative of tϕrot is determined using ṡh and ψtroll by

ϕ˙trot=ktrotψ˙troll+2s˙hcostαdtpipe,    (20)

where tkrot is the rotation angle around the tail axis per unit rolling angle. tkaxis and tkrot depend on the parameters of the tail winding part. It is difficult to analytically derive these values because of the fitting error of the robot and the slippage between robot and pipe. Therefore, these are actually measured in experiments in which only the rolling motion is performed.

4.2.2. Derivation for Fixing the Dodging Part

We derive the appropriate value of ψ0, the time derivative of the initial twist angle ψ0, to realize ψtroll and ψhroll in the previous section.

The point a away from the head of the robot is sr = sha (0 ≤ alrobot) on the target curve. From (5), ψ(sr), the rolling velocity at s = sr, is expressed as

ψ(sr)=srddsr0srτ(s^)ds^+ψ0+ddtjψ^ju(sr-sj).    (21)

After substituting sr = sha and rearranging the equation, this equation is expressed as

ψ(sh-a)=τ(sh-a)sh+ψ0+jψ^ju(sh-a-sj)+jψ^jδ(sh-a-sj)sh,    (22)

where δ is the impulse function. The impulse function has zero value except at the connection-part, where shasj = 0. On the other hand, the impulse function has non-zero value at the connection-part. However, it doesn't have any effect on the overall movement of the robot because the length of the connection-part is zero. Therefore, the last term on the right-hand side is negligible. The points on the tail winding part and on the head winding part in the target curve are represented as sr=sh-ta and sr=sh-ha, respectively. To realize ψ(sh-ta)=tψroll on the tail winding part and ψ(sh-ha)=hψroll on the head winding part, the desired values of ψ0 on the tail winding part and on the head winding part are given by

ψ˙troll=ψ˙0+τtws˙h,    (23)
ψ˙hroll=ψ˙0+τhws˙h+ϕ˙trotϕ˙hrot,    (24)

where tτw and hτw denote the torsions of the tail and head winding parts, respectively.

When both of these winding parts have the same radius, ψtroll=ϕhroll, tτw = hτw, and ϕtrot=ϕhrot. Therefore, (23) and (24) are satisfied simultaneously. This means that the fixing of the dodging part can be realized rigidly without the slip between the robot and pipe, which depends on the frictional condition and model.

However, when both winding parts have different radii, ψtrollψhroll, tτwhτw and ϕtrotϕhrot. Therefore, there is no ψ0 that satisfies (23) and (24) at the same time. For any value of ψ0, the slip occurs between the robot and pipe on one or both of the head and tail winding parts. This slip is possible to prevent the fixing of the dodging part which is based on the assumption of no slip. Hence, the model including the slip between the robot and pipe is required to realize the fixing of the dodging part.

4.2.3. Model Including Slip Between Robot and Pipe

We next consider a model that includes the slip between the robot and pipe, and aim to derive the relationship between the shift velocity, ψ0, and ϕdiff to fix the dodging part against the pipe, where

ϕdiff=tϕrot-hϕrot+ωslip.    (25)

Here, ωslip is the sum of the slip angular velocity around the axis on the tail and head winding parts.

Let us assume viscous friction between robot and pipe as in Saito et al. (2002), Liljebäck et al. (2010), Ariizumi and Matsuno (2017), and Ariizumi et al. (2018). The friction is assumed to be proportional to the normal force from the pipe as in Hicks and Ito (2005) and Ariizumi and Matsuno (2017). The normal force is considered to work equally along the body of the robot and is represented as T = ρlcont, which is proportional to the contact length lcont. ρ is the coefficient of pressure per unit contact length. Here, the equilibrium of force in the axial direction is represented as

μtvslipρtlw+μhvslipρhlw=0,    (26)

where μ is the coefficient of friction, and tvslip and hvslip are the slip velocities in the axial direction on the tail and head winding parts, respectively. Also, tlw and hlw are respectively the lengths of the tail and head winding parts within the range corresponding to the robot's body in the target curve. We next consider the velocity of the dodging part against the pipe. In order to fix the dodging part against the pipe, we consider the velocity occurring by shift control, rolling motion, and slip, and make its value zero. Since the target form is connected continuously, the two ends of the dodging part have the same velocity against the pipe vdod. Our purpose is to make vdod zero.

4.2.3.1. Change in Pipe Diameter

In the case of a change in diameter, the velocity of the dodging part in the axial direction, as shown in Figure 6A, is represented as

vdod=ktaxisψ˙trolls˙hsintα+vtslip      =khaxisψ˙hrolls˙hsinhα+vhslip.    (27)

Using (23), (24), and (26), (27) is rewritten as

vdod=ktaxisψ˙0(ktaxisτtw+sintα)s˙h+vtslip    (28)
             =khaxisψ˙0(khaxisτhw+sinhα)s˙hltwlhwvtslip             khaxisϕ˙diff.    (29)

Moreover, ϕdiff is expressed using ψ0, ṡh, and ωslip by substituting (20) into (25) as

ϕdiff=Aψ0+Bsh+ωslip,    (30)

where

A=ktrotkhrot1khrot,B=ktrotτtw+2 costαdtpipe+khrotτhw2 coshαdhpipe1khrot.    (31)

Eventually, by substituting (30) into (29), (27) is expressed as

vdod=ktaxisψ˙0(ktaxisτtw+sintα)s˙h+vtslip    (32)
             =khaxis(1+A)ψ˙0{khaxis(τhw+B)+sinhα}s˙h             ltwlhwvtslipkhaxisωslip.    (33)

As mentioned initially, our purpose is to derive ψ0 and ϕdiff as functions of the input value in Step 4 ṡh, to realize the fixing of the dodging part, i.e., vdod = 0. In addition to three equations, (30), (32), and (33), another equation is needed to designate four variables, ψ0, ϕdiff, tvslip, and ωslip. We introduce the control of the balance between the slip in the axial direction tvslip and slip around the axis ωslip as another equation. There is a trade-off relationship between tvslip and ωslip, and cannot be zero at the same time in the case of the different radii of the head and tail winding parts. Here, we deal with two extreme instances: (A) a motion that no slip occurs around the axis but slip occurs in the axial direction (tvslip ≠ 0, ωslip = 0) and (B) a motion that where no slip occurs in the axial direction but slip occurs around the axis (tvslip = 0, ωslip ≠ 0). In (A), the slip in the axial direction tdpipe should be derived based on the slip model to fix the dodging part, whereas the slip around the axis ωslip is determined to be zero. In (B), the slip around the axis ωslip should be derived based on the slip model to fix the dodging part, whereas the slip in the axial direction tvslip is determined to be zero.

FIGURE 6
www.frontiersin.org

Figure 6. (A) Velocity of the dodging part in the axial direction in the case of a change in diameter. (B) Velocity of the dodging part in the axial direction in the case of inside-out motion. (C) ψ0 for the inside-out motion obtained by (42).

(A) No slip around the axis but slip in the axial direction:

We discuss the motion of no slip around the axis but slip in the axial direction (tvslip ≠ 0, ωslip = 0) first. Since the position of the dodging part in the axial direction is designed to be fixed relying on the slip in the axial direction tvslip, the position is possible to be moved if there is the modeling error of the slip in the axial direction. On the other hand, the direction of the dodging part is able to be fixed precisely because there is no slip around the axis. Therefore, this motion is suitable for navigating around an obstacle for which the direction of the dodging part should be neatly fixed. In this motion, from (32), (33), and ωslip = 0, the velocity of the dodging part is represented as

vdod=FtltwFhlhwltw+lhwψ˙0GtltwGhlhw(1khrot)(ltw+lhw)s˙h.    (34)

where

Ft=ktaxis,Fh=1ktrot1khrotkhaxis,Gt=ktaxisτtw+sintα,Gh=khaxis1khrot(ktrotτtw+2 costαdtpipe+hτw2 coshαdhpipe)     +sinhα.    (35)

Therefore, ψ0 to fix the dodging part in the axial direction, i.e., to realize vdod = 0, is obtained by

ψ˙0=Gtltw+GhlhwFtltw+Fhlhws˙h.    (36)

Then, ϕdiff is calculated by substituting ωslip = 0 and (36) into (30) as

ϕ˙diff=Aψ˙0+Bs˙h,=(Gtltw+GhlhwFtltw+FhlhwA+B)s˙h.    (37)

(B) No slip in the axial direction but slip around the axis:

Next, let us consider the motion of no slip in the axial direction but slip around the axis (tvslip = 0, ωslip ≠ 0). Since the direction of the dodging part is designed to be fixed relying on the slip around the axis ωslip, the direction is possible to be moved if there is the modeling error of the slip around the axis. On the other hand, the position of the dodging part in the axial direction is able to be fixed precisely because there is no slip in the axial direction. Hence, this motion is effective when the position of the dodging part in the axial direction has to be maintained primarily, e.g., a change in diameter whose target form is axially symmetric as described later. Using (28), (29), and tvslip = 0, ψ0 and ωslip to fix the dodging part are obtained by

ψ˙0=(τtw+sintαktaxis)s˙h,    (38)
ϕ˙diff=(τtw+sintαktaxisτhwsinhαkhaxis)s˙h.    (39)

Note that these two motions (A) and (B) are equal to each other in the junction, bend, shear, and blockage, which can be negotiated without any slip in the axial direction and around the axis. For these cases, tvslip and ϕdiff become zero, and the same result is derived as in section 4.2.1.

4.2.3.2. Motion Between Inside and Outside

We next consider a case of inside-out motion. As in the case of a change in diameter, the equilibrium of force in the axial direction is described as (26). Then, the velocity of the two ends of the dodging part, as shown in Figure 6B, is represented as

vdod=ktaxisψ˙trolls˙hsintα+vtslip=khaxisψ˙hroll+s˙hsinhα+vhslip.    (40)

(A) No slip around the axis but slip in the axial direction:

We begin, as before, with the motion of no slip around the axis but slip in the axial direction (tvslip ≠ 0, ωslip = 0). From (26), (40), and ωslip = 0, the velocity of the dodging part is represented as

vdod=FtltwFhlhwltw+lhwψ˙0GtltwGhlhwltw+lhws˙h.    (41)

Therefore, ψ0 and ϕdiff to realize vdod = 0 is derived by

ψ˙0=GtltwGhlhwFtltwFhlhws˙h,    (42)
ϕ˙diff=(GtltwGhlhwFtltwFhlhwA+B)s˙h.    (43)

Here, ψ0 ends up diverging when the denominator tFtlwhFhlw becomes zero, as shown in Figure 6C. Therefore, we introduce the limitations -ψ0,lim and ψ0,lim for ψ0 so as not to require a rapid change in the joint angle that the actuator cannot realize. The effect of this limitation must be considered. Since vdod is a linear function of ψ0, the sign of vdod is determined by the coefficient of ψ0 and whether ψ0 is larger or smaller than ψ0 to realize vdod = 0 (42). Before the divergence, tFtlwhFhlw is positive and the coefficient of ψ0 in (41) becomes positive. Here, tlw + hlw > 0 satisfies because tlw and hlw are the lengths of the winding parts within the approximation range of the robot. -ψ0,lim is smaller than ψ0 obtained by (42), as shown in Figure 6C. After the divergence, tFtlwhFhlw is negative, the coefficient of ψ0 in (41) becomes negative. ψ0,lim is larger than ψ0 obtained by (42), as shown in Figure 6C. Therefore, vdod becomes negative while the limitation is imposed on ψ0. This vdod < 0 indicates that both the head and tail winding parts move to the side of the pipe until segment-5 contacts the pipe's edge. This phenomenon only fixes the dodging part and doesn't interfere with overall motions, such as the robot falling out of the pipe.

(B) No slip in the axial direction but slip around the axis:

We next consider the motion of no slip in the axial direction but slip around the axis (tvslip = 0, ωslip ≠ 0). This motion is also suitable for the inside-out motion because its target form is axially symmetric, as described later, and the displacement of the dodging part in the axial direction has to be maintained more appropriately than the rotation of the dodging part around the axis. Using (40), ψ0 and ϕdiff to fix the dodging part, i.e., to realize vdod = 0, are obtained by (38) and (39), the same equations as in the case of the change in diameter.

Note that the position in the axial direction of the dodging part can be compensated by the rolling motion, and the direction of the dodging part can be compensated by ϕoffset if the dodging part deviates from the appropriate position and direction during movement.

5. Form Design for Application

In this section, we present the design of the dodging parts for a junction, bend, shear, blockage, and change in pipe diameter and the design of a guiding part for outside the pipe for the motion between the inside and outside of a pipe as examples of applications of the proposed motion.

5.1. Junction and Bend

The target form for a junction and bend is presented in Figure 7A. The dodging part is composed of segment-5, an arc segment, whose parameters are (rj, ϕj) = (rbend, ϕbend) and ψ^5=π-hϕrot. For a junction, rbend is the outer radius of a pipe and ϕbend is the bending angle of the junction. For a bend, rbend is the radius and ϕbend is the bending angle of the bend.

FIGURE 7
www.frontiersin.org

Figure 7. Segment configuration for (A) junction and bend, (B) shear, (C) blockage, (D) change in diameter, and (E) inside-out motion.

5.2. Shear

The target form for shear is shown in Figure 7B. The dodging part is composed of segments-5–8, which are arc segments whose parameters are (rj, ϕj) = (rc, γs), ψ^5=ψ^6=ψ^7=π, and ψ^8=π-hϕrot. The dodging part is defined by the distance between the two axes of pipes dshear. γs is calculated from,

γs=arccos(1-dshear4rc).    (44)

5.3. Blockage

The target form for a blockage is illustrated in Figure 7C. The dodging part is composed of four arc segments-5, 6, 8, 9, whose parameters are (rj, ϕj) = (rc, γblock) and (ψ^5,ψ^6,ψ^8,ψ^9) = (π,0,0,π,-π2-hϕrot), and a straight line segment-7, whose parameters are lj = lblock and ψ^7=0. The dodging part is determined by its width dblock, which is defined as the length between the axis of the pipe and the straight line segment parallel to the axis, and l7 = lblock, depending on the shape of the blockage. The geometric parameter γblock is calculated from,

γblock=arccos(1-dblock2rc).    (45)

5.4. Change in Pipe Diameter

The target form for a change in pipe diameter is shown in Figure 7D. The dodging part is composed of segment-5, a straight line segment, whose parameters are l5 = ldc and ψ^5=0. Since the dodging part is the straight line segment and ψ^5=0, ψ^4 is determined by ψ^4=π+ϕoffset+ϕdiff instead, where ϕdiff is the time integral of ϕdiff. The determination of the dodging part depends on the length of the part of the pipe where the diameter changes. This form is axisymmetric, and the direction of the dodging part does not matter. Hence we set ϕoffset = 0. Eventually, ψ^4 is determined by ψ^4=π+ϕdiff.

5.5. Motion Between Inside and Outside

Expanding on the proposed motion, we propose a motion that corresponds to passing between the inside and outside of a pipe. This motion is useful when a pipe opening is difficult to approach directly or when a pipe needs to be inspected from both inside and outside. The target form for this motion is illustrated in Figure 7E, and the parameters for each segment are shown in Table 2. To begin, we design the guiding part for outside the pipe. Here segments-5–7 comprise the head guiding part, which is fixed by the radius of segment-5 rio. γio and lio are given by

γio=arcsinrhw2rio,    (46)
lio=(2rio)2-hrw2-rc{1-cos(π2-hα)}coshα.    (47)

Here, rio should be determined so that lio ≥ 0 holds. In this way, the proposed motion available for an arbitrary dodging part can be expanded to outside the pipe by designing guiding part for the outside. This target form does not have a dodging part, and the tail guiding part is directly connected to the head guiding part. Therefore, this motion can also be realized in the same way as for inside the pipe, by determining ψ^4=π+ϕdiff. For the motion from outside to inside a pipe, the tail guiding parts are composed of segments listed in the opposite order in Table 2.

TABLE 2
www.frontiersin.org

Table 2. Parameters of the segments comprising the head guiding part for the outside of a pipe.

6. Experimental Results

We performed experiments to verify the effectiveness of the proposed method. The system configuration of a snake robot is illustrated in Figure 8. We used the snake robot developed in Takemori et al. (2018b). The snake robot has a module configuration, which has a joint and link covered by an exterior. This exterior has a pectinate shape, providing a smooth surface without affecting the bending of the joint. The number of joints is 36, the link length is 70 mm, the diameter of the link is 56 mm, the weight per link is 150 g, the maximum torque of a joint is 4.0 Nm, and the maximum bending angle of a joint is 90°. The motor was driven by the position control with the limitation of the current (0.3 A) to allow the compliance of the joint, and the PID gains are set as (P, I, D) = (800, 0, 100). The snake robot is powered via a cable, and the target angle for each joint is sent from a computer via an RS485 interface. The camera is mounted on the head to inspect the pipe and to help the operator control the robot remotely. The operator uses a gamepad to perform an operation.

FIGURE 8
www.frontiersin.org

Figure 8. System configuration of a snake robot developed in Takemori et al. (2018b).

The pipes used most have an inner diameter of 194 mm and an outer diameter of 200 mm. The only pipe used in the experiments involving a change in pipe diameter had an inner diameter of 290 mm. The parameters used in the experiments are listed in Table 3. Here, index m means t or h. mkaxis and mkrot for each pipe were measured in the preliminary experiments in which only the rolling motion was performed. We determined rc = 90 mm for all subsequent cases.

TABLE 3
www.frontiersin.org

Table 3. Parameters used in experiments.

We measured the static coefficient between the robot surface and inner wall of the pipe. We put one unit of the robot, which is composed of one link and one joint, on the pipe and measured the tilted angle of the pipe when the unit started sliding. The unit started sliding when the tilted angle was about 16°, and then, the measured static coefficient was arctan16° = 0.27. This value is the reference value because it seems to be easily changed according to the condition of contact.

6.1. Evaluation of Proposed Slip Model

First, we conducted experiments to verify the model considering the slip in cases where the head and tail winding parts have different radii based on the displacement of the dodging part in the axial direction. If two pipes have different radii, it is physically impossible for a winding part having a larger radius to enter the smaller pipe. In this case, the displacement of the dodging part toward the smaller pipe is altered constrainedly and cannot be observed correctly. Therefore, two pipes having the same diameter, 194 mm, were used instead, and the tail winding part, for this experiment only, had a larger pitch (tpw = 600 mm) than the head winding part (hpw = 501 mm). To clearly show the displacement of the dodging part, the head of the robot was located between the ends of two pipes at the beginning of the experiment, as indicated by the dotted line in Figure 7. Then, the shift control, combined with the rolling motion and the change in ψ^4 calculated in Motions 1–4 [(Motion 1) considering the displacement only on the tail winding part (23), (Motion 2) considering the displacement only on the head winding part (24), (Motion 3) considering the displacement with the slip between the robot and pipe in the motion of no slip around the axis but slip in the axial direction (tvslip ≠ 0, ωslip = 0), and (Motion 4) considering the displacement with the slip in the motion of no slip in the axial direction but slip around the axis (tvslip = 0, ωslip ≠ 0)], was conducted in Step 4 until the tail of the robot reached the head guiding part. Considering the target form of the robot as shown in Figure 7D when ldc = 0 mm, the tail of the robot is located just between the ends of two pipes at the end of the experiment if the dodging part is fixed properly. Therefore, we measured the position of the tail of the robot at the end of each experiment, as indicated by the red line in the image, and compared it under four conditions. Note that this experiment is focused on the fixing of the position of the dodging part only in the axial direction since it is difficult to observe the change of the direction of the dodging part in the axially symmetric target form. The results and data of these experiments are shown in Figure 9. When the displacement of the dodging part was considered on either the tail winding part or the head winding part (Motion 1 and Motion 2), the error was 458 or 222 mm, respectively. On the other hand, the proposed model (tvslip ≠ 0, ωslip = 0) (Motion 3) produced less error, 97 mm. Furthermore, the proposed model considering the slip (tvslip = 0, ωslip ≠ 0) (Motion 4) produced the smallest error, 5 mm. These results indicated that Motion 1 and Motion 2 produces the large errors because they ignore the effect of the slip. Motion 3 reduced the error compared with the first two motions by fixing the dodging part in consideration of the slip. However, a small error was left due to the modeling error caused by the viscous friction model or the condition of the contact in the axial direction because Motion 3 is relying on the slip in the axial direction. In contrast, Motion 4 successfully realized the fixing of the dodging part in the axial direction as expected because it did not require the slip in the axial direction and was not affected by the modeling error of the slip in the axial direction. Consequently, the proposed motions based on the slip model both in the cases of (tvslip ≠ 0, ωslip = 0) and (tvslip = 0, ωslip ≠ 0) are regarded as effective for fixing the dodging part. The reduction of the modeling error of the slip is left as our future task.

FIGURE 9
www.frontiersin.org

Figure 9. Experimental results and data from preliminary experiments. (A,B) Motion 1: fixing the dodging part only on the tail winding part, (C,D) Motion 2: fixing the dodging part only on the head winding part, (E,F) Motion 3: employing the proposed slip model (tvslip ≠ 0, ωslip = 0), and (G,H) Motion 4: employing the proposed slip model (tvslip = 0, ωslip ≠ 0).

6.2. Experiments for Various Pipe Structures

We then performed four experiments in which the robot negotiated a junction, a shear, a blockage, and a discontinuous change in diameter. As mentioned in section 5, the target form for a bend is similar to that for a junction, and the target form for a continuous change in pipe diameter is similar to that for a discontinuous change in pipe diameter. Therefore, these four experiments can demonstrate the effectiveness of the proposed method for all pipe structures in Figure 1A. Also, we performed an experiment in which the movement is from inside to outside a pipe. The operator looked at the snake robot directly and performed the operation according to the procedure described in the first part of section 4.2.

As shown in Figures 10A–D, the snake robot successfully negotiated the junction, shear, blockage, and change in pipe diameter. The snake robot was also able to move from the inside to the outside of the pipe, as shown in Figure 10F. Please also see the Supplementary Video 1 for details. Figure 11 indicates the values of ψ0, sh, and ϕoffset for each experiment. For the experiments involving a junction, shear, and blockage, the robot was able to negotiate the pipe under shift control and rolling motion, as described in section 4.2, with only the first adjustment by the operator of the position and direction of the dodging part in Step 3.

FIGURE 10
www.frontiersin.org

Figure 10. Experimental results of (A) negotiating a junction (rbend = 100 mm and rbend=90), (B) negotiating shear (dshear = 100 mm), (C) negotiating a blockage (the right half of the pipe is blocked in width by 10 mm, and dblock = 48.5 mm, lblock = 30 mm), (D) negotiating a change in diameter (pipe inner diameter changes from 290 to 194 mm, and ldc = 0 mm) using the proposed slip model (tvslip ≠ 0, ωslip = 0), (E) moving from inside to outside a pipe using the proposed slip model (tVslip ≠ 0, ωslip = 0, rio = 90 mm, ψ0,limit=0.03 rad/s), and (F) moving from inside to outside a pipe using the proposed slip model (tVslip ≠ 0, ωslip = 0, rio = 90 mm).

FIGURE 11
www.frontiersin.org

Figure 11. Experimental data on (A) negotiating a junction, (B) negotiating a shear, (C) negotiating a blockage, (D) negotiating a change in diameter using the proposed slip model (tvslip ≠ 0, ωslip = 0), (E) moving from inside to outside a pipe using the proposed slip model (tvslip ≠ 0, ωslip = 0), and (F) moving from inside to outside a pipe using the proposed slip model (tVslip = 0, ωslip ≠ 0).

Since the junction is the severest obstacle that does not allow the slightest deviation of the position and direction of the dodging part, the experiment to verify the angle error of the joint between the desired angle and the actual angle was also conducted for negotiating a junction. Due to the limitation of the communication speed, the time step of this experiment (Δt = 0.2 s) is 10 times as large as that of the other experiments to obtain the joint angle. As shown in Figure 12B, the actual angle of the joint θi(t) (green line) lagged behind the desired angle θid(t) (black line). This steady delay is thought to be caused by the communication delay to send the desired angle to each joint and receive the actual angle from each joint and the time delay needed to change the angle of each joint from the actual angle to the desired angle due to the limitation of the speed of the motor. The length of the time delay was about five steps for every joint except the first joint, which responded one time step earlier than the others. The actual angle moved forward five steps θi(t + 5Δt) (red line) matched the desired angle well for the second joint as shown in the bottom of the Figure 12A, although the error about one time step was left only for the first joint. The angle error between the desired and actual angle for each joint (θi(t)-θid(t)) is depicted in the top of the Figure 12B. To eliminate the effect of the time delay, the angle error between the desired and shifted actual angle for five time steps for each joint (θi(t)-θid(t+5Δt)) is depicted in the bottom of the Figure 12B. As shown in the bottom of the Figure 12B, the comparatively large angle error of the joint was moved from head to tail with the passage of time. This indicates that the angle error was observed near the dodging part as enclosed with dotted lines in Figure 12B and the dodging part deviates from the appropriate position and direction to some extent. In addition, the error of the last joint, 36th joint, is quite large at t = 62 s. This is because the tail link is longer than the other links and was caught by the pipe when it passed through the junction. The error of the position and direction of the dodging part is thought to be compensated by two factors caused by the robot's geometric constraints: the compliant adaptation to the environment at the joint thanks to the position control of the motor with the limitation of the torque, and the slippage between the robot and the pipe.

FIGURE 12
www.frontiersin.org

Figure 12. Experimental data of the joint angle for negotiating a junction. (A) Time delay of the joint angle for the first joint (top) and the second joint (bottom). (B) Angle error of the joint between the desired angle and the actual angle of the joint (top). and shifted angle error of the joint between the desired angle and the actual angle moved forward 5 time steps (bottom). Angle error and shifted angle error of the 1–12th joints, the 13–24th joints, and the 25–36th joints are shown in the left, center, and right panel of the figures, respectively.

Also, the robot was able to negotiate the change in diameter with the proposed model considering the slip between the robot and the pipe even when the radii of the head and tail winding parts differed. Figure 10D shows only the result of the proposed model (tvslip ≠ 0, ωslip = 0), but the model (tvslip = 0, ωslip ≠ 0) also worked successfully; see Supplementary Video 1. In contrast, the robot failed to move from inside to outside the pipe using the proposed slip model (tvslip ≠ 0, ωslip = 0), as in Figure 10E, and succeeded to do so only with the proposed slip model (tvslip = 0, ωslip ≠ 0) Figure 10F. As shown in the middle panel of Figure 10E, the robot was unable to support the part of itself that was below the pipe due to the torque limitation of the motor, and the head winding part did not contact the pipe and receive the friction force, contrary to what we had expected. Hence, the dodging part moved the right side of the image, although in theory it was expected to move to the left side of the image after ψ0 reached -ψ0,limit. This effect led the robot to fall out of the pipe. On the other hand, since the experiment shown in Figure 10F was conducted using the proposed slip model (tvslip = 0, ωslip ≠ 0), the dodging part did not deviate from the proper position in the axial direction even though the robot was not always able to press its body against the pipe. Instead, the rotation of the robot around the axis was found to be caused by the slip around the axis. In addition, due to the torque limitation of the motor, the robot is likely to failed to support the head winding part for both Figures 10E,F of the revised paper depending on the initial orientation of the robot and the protective function of the motor, which made the motor output torque zero when the motor detects the persistent load that exceeds maximum output.

7. Conclusion

A unified approach was proposed for designing the motion that enables a snake robot to negotiate complicated pipe structures. The proposed method enables the robot to overcome various obstacles by designing the dodging part, which is part of the target form, specifically for the obstacle. To realize this, both ends of the dodging part are arranged on the axes of the pipes with guiding parts. In addition, we developed a method of fixing the dodging part to an obstacle during obstacle negotiation that involved an appropriate combination of rolling motion and shift control. Also, we constructed a model considering slippage between robot and pipe, and expanded the proposed method to make it applicable to motions that require two helices having different radii, i.e., the motion for change in diameter and the motion between inside and outside of a pipe. We conducted experiments to verify the effectiveness of these methods and demonstrated that the snake robot successfully negotiated not only a junction, which was already realized, but also a shear, a blockage, and a discontinuous change in pipe diameter, which were impossible previously. We also realized movement from inside to outside a pipe in an experiment.

We shall in a future study consider a way to conduct remote operations more easily. Currently, the operator has to adjust appropriately the relative position of the dodging part to the environment. Also, experiments are now conducted in the ideal situation where the operator can recognize the state of the robot by directly looking at the robot through the transparent pipe. We also leave as a future task the realization of autonomous movement by detecting a pipe structure using sensors given no parameter values. Finally, another task for the future is a kinematic/dynamic analysis of the motion to keep the appropriate contact with the pipe.

Data Availability Statement

The original contributions presented in the study are included in the article/Supplementary Material, further inquiries can be directed to the corresponding author/s.

Author Contributions

MI: writing the paper, developing the theory, and running experiments. TT: developing the theory, running experiments, providing feedback to theoretical and experimental results, and providing feedback on drafts of the report. MT and FM: developing the theory, providing feedback to theoretical and experimental results, and providing feedback on drafts of the report. All authors contributed to the article and approved the submitted version.

Funding

This work was partially supported by the ImPACT Program of the Council for Science, Technology and Innovation (Cabinet Office, Government of Japan).

Conflict of Interest

The authors declare that the research was conducted in the absence of any commercial or financial relationships that could be construed as a potential conflict of interest.

Acknowledgments

The content of this manuscript has been presented in part at the IEEE International Conference on Robotics and Automation (Inazawa et al., 2020).

Supplementary Material

The Supplementary Material for this article can be found online at: https://www.frontiersin.org/articles/10.3389/frobt.2021.629368/full#supplementary-material

Supplementary Video 1. Pipe negotiation.

References

Andersson, S. B. (2008). Discretization of a continuous curve. IEEE Trans. Robot. 24, 456–461. doi: 10.1109/TRO.2008.917000

CrossRef Full Text | Google Scholar

Ariizumi, R., and Matsuno, F. (2017). Dynamic analysis of three snake robot gaits. IEEE Trans. Robot. 33, 1075–1087. doi: 10.1109/TRO.2017.2704581

CrossRef Full Text | Google Scholar

Ariizumi, R., Takahashi, R., Tanaka, M., and Asai, T. (2018). Head-trajectory-tracking control of a snake robot and its robustness under actuator failure. IEEE Trans. Control Syst. Technol. 27, 2589–2597. doi: 10.1109/TCST.2018.2866964

CrossRef Full Text | Google Scholar

Baba, T., Kameyama, Y., Kamegawa, T., and Gofuku, A. (2010). “A snake robot propelling inside of a pipe with helical rolling motion,” in Proceedings of the SICE Annual Conference (Taipei), 2319–2325. doi: 10.1109/SSRR.2011.6106789

CrossRef Full Text | Google Scholar

Crespi, A., and Ijspeert, A. J. (2008). Online optimization of swimming and crawling in an amphibious snake robot. IEEE Trans. Robot. 24, 75–87. doi: 10.1109/TRO.2008.915426

CrossRef Full Text | Google Scholar

Hatton, R. L., and Choset, H. (2010). Generating gaits for snake robots: annealed chain fitting and keyframe wave extraction. Auton. Robots 28, 271–281. doi: 10.1007/s10514-009-9175-2

CrossRef Full Text | Google Scholar

Hicks, G., and Ito, K. (2005). A method for determination of optimal gaits with application to a snake-like serial-link structure. IEEE Trans. Autom. Control 50, 1291–1306. doi: 10.1109/TAC.2005.854583

CrossRef Full Text | Google Scholar

Hirose, S. (1987). Biologically Inspired Robots (Snake-Like Locomotor and Manipulator). London: Oxford University Press.

Google Scholar

Inazawa, M., Takemori, T., Tanaka, M., and Matsuno, F. (2020). “Motion design for a snake robot negotiating complicated pipe structures of a constant diameter,” in Proceedings of the IEEE International Conference on Robotics and Automation (Paris), 8073–8079. doi: 10.1109/ICRA40945.2020.9197224

CrossRef Full Text | Google Scholar

Kamegawa, T., Baba, T., and Gofuku, A. (2011). “V-shift control for snake robot moving the inside of a pipe with helical rolling motion,” in Proceedings of the IEEE International Symposium on Safety, Security, and Rescue Robotics (Kyoto), 1–6.

Google Scholar

Kamegawa, T., Harada, T., and Gofuku, A. (2009). “Realization of cylinder climbing locomotion with helical form by a snake robot with passive wheels,” in Proceedings of the IEEE International Conference on Robotics and Automation (Kobe), 3067–3072. doi: 10.1109/ROBOT.2009.5152862

CrossRef Full Text | Google Scholar

Kano, T., Yoshizawa, R., and Ishiguro, A. (2018). “Snake-like robot that can generate versatile gait patterns by using tegotae-based control,” in Proceedings of the International Conference on Biomimetic and Biohybrid Systems (Paris), 249–254. doi: 10.1007/978-3-319-95972-6_26

CrossRef Full Text | Google Scholar

Liljebäck, P., Pettersen, K. Y., Stavdahl, Ø., and Gravdahl, J. T. (2010). Controllability and stability analysis of planar snake robot locomotion. IEEE Trans. Autom. Control 56, 1365–1380. doi: 10.1109/TAC.2010.2088830

CrossRef Full Text | Google Scholar

Liljebäck, P., Pettersen, K. Y., Stavdahl, Ø., and Gravdahl, J. T. (2014). “A 3D motion planning framework for snake robots,” in Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems (Chicago, IL), 1100–1107. doi: 10.1109/IROS.2014.6942695

CrossRef Full Text | Google Scholar

Matsuno, F., and Sato, H. (2005). “Trajectory tracking control of snake robots based on dynamic model,” in Proceedings of the IEEE International Conference on Robotics and Automation (Barcelona), 3029–3034. doi: 10.1109/ROBOT.2005.1570575

CrossRef Full Text | Google Scholar

Mohammadi, A., Rezapour, E., Maggiore, M., and Pettersen, K. Y. (2015). Maneuvering control of planar snake robots using virtual holonomic constraints. IEEE Trans. Control Syst. Technol. 24, 884–899. doi: 10.1109/TCST.2015.2467208

PubMed Abstract | CrossRef Full Text | Google Scholar

Nakajima, M., Tanaka, M., and Tanaka, K. (2019). Simultaneous control of two points for snake robot and its application to transportation. IEEE Robot. Autom. Lett. 5, 111–118. doi: 10.1109/LRA.2019.2947003

CrossRef Full Text | Google Scholar

Qi, W., Kamegawa, T., and Gofuku, A. (2018). Helical wave propagation motion for a snake robot on a vertical pipe containing a branch. Artif. Life Robot. 23, 515–522. doi: 10.1007/s10015-018-0479-1

CrossRef Full Text | Google Scholar

Rollinson, D., and Choset, H. (2016). Pipe network locomotion with a snake robot. J. Field Robot. 33, 322–336. doi: 10.1002/rob.21549

CrossRef Full Text | Google Scholar

Saito, M., Fukaya, M., and Iwasaki, T. (2002). Serpentine locomotion with robotic snakes. IEEE Control Syst. Mag. 22, 64–81. doi: 10.1109/37.980248

CrossRef Full Text | Google Scholar

Sartoretti, G., Paivine, W., Shi, Y., Wu, Y., and Choset, H. (2019). Distributed learning of decentralized control policies for articulated mobile robots. IEEE Trans. Robot. 35, 1109–1122. doi: 10.1109/TRO.2019.2922493

CrossRef Full Text | Google Scholar

Takemori, T., Tanaka, M., and Matsuno, F. (2018a). Gait design for a snake robot by connecting curve segments and experimental demonstration. IEEE Trans. Robot. 34, 1384–1391. doi: 10.1109/TRO.2018.2830346

CrossRef Full Text | Google Scholar

Takemori, T., Tanaka, M., and Matsuno, F. (2018b). “Ladder climbing with a snake robot,” in Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems (Madrid), 1–9. doi: 10.1109/IROS.2018.8594411

CrossRef Full Text | Google Scholar

Tanaka, M., Kon, K., and Tanaka, K. (2015). Range-sensor-based semiautonomous whole-body collision avoidance of a snake robot. IEEE Trans. Control Syst. Technol. 23, 1927–1934. doi: 10.1109/TCST.2014.2382578

CrossRef Full Text | Google Scholar

Tesch, M., Lipkin, K., Brown, I., Hatton, R., Peck, A., Rembisz, J., et al. (2009). Parameterized and scripted gaits for modular snake robots. Adv. Robot. 23, 1131–1158. doi: 10.1163/156855309X452566

CrossRef Full Text | Google Scholar

Wu, X., and Ma, S. (2013). Neurally controlled steering for collision-free behavior of a snake robot. IEEE Trans. Control Syst. Technol. 21, 2443–2449. doi: 10.1109/TCST.2012.2237519

CrossRef Full Text | Google Scholar

Yamada, H., and Hirose, S. (2006). “Study on the 3D shape of active cord mechanism,” in Proceedings of the IEEE International Conference on Robotics and Automation (Orlando, FL), 2890–2895. doi: 10.1109/ROBOT.2006.1642140

CrossRef Full Text | Google Scholar

Yamada, H., and Hirose, S. (2008). Study of active cord mechanism–approximations to continuous curves of a multi-joint body. J. Robot. Soc. Jpn. 26, 110–120. doi: 10.7210/jrsj.26.110

CrossRef Full Text | Google Scholar

Yaqub, S., Ali, A., Usman, M., Zuhaib, K. M., Khan, A. M., An, B., et al. (2019). A spiral curve gait design for a modular snake robot moving on a pipe. Int. J. Control Autom. Syst. 17, 2565–2573. doi: 10.1007/s12555-019-0074-9

CrossRef Full Text | Google Scholar

Zhen, W., Gong, C., and Choset, H. (2015). “Modeling rolling gaits of a snake robot,” in Proceedings of the IEEE International Conference on Robotics and Automation (Washington, DC), 3741–3746.

Google Scholar

Zhou, Y., Zhang, Y., Ni, F., and Liu, H. (2017). “A spring-like pipe climbing gait for the snake robot,” in Proceedings of the IEEE International Conference on Robotics and Biomimetics (Macau), 1886–1891. doi: 10.1109/ROBIO.2017.8324694

CrossRef Full Text | Google Scholar

Keywords: snake robots, pipe inspection, bio-inspired robots, redundant robots, motion design

Citation: Inazawa M, Takemori T, Tanaka M and Matsuno F (2021) Unified Approach to the Motion Design for a Snake Robot Negotiating Complicated Pipe Structures. Front. Robot. AI 8:629368. doi: 10.3389/frobt.2021.629368

Received: 14 November 2020; Accepted: 29 March 2021;
Published: 03 May 2021.

Edited by:

Dai Owaki, Tohoku University, Japan

Reviewed by:

Takeshi Kano, Tohoku University, Japan
Atsushi Kakogawa, Ritsumeikan University, Japan

Copyright © 2021 Inazawa, Takemori, Tanaka and Matsuno. This is an open-access article distributed under the terms of the Creative Commons Attribution License (CC BY). The use, distribution or reproduction in other forums is permitted, provided the original author(s) and the copyright owner(s) are credited and that the original publication in this journal is cited, in accordance with accepted academic practice. No use, distribution or reproduction is permitted which does not comply with these terms.

*Correspondence: Mariko Inazawa, inazawa.mariko.35w@st.kyoto-u.ac.jp

Disclaimer: All claims expressed in this article are solely those of the authors and do not necessarily represent those of their affiliated organizations, or those of the publisher, the editors and the reviewers. Any product that may be evaluated in this article or claim that may be made by its manufacturer is not guaranteed or endorsed by the publisher.