Professional Documents
Culture Documents
Abstract—A wheeled-type pipe inspection robot designed to Another type of pipe inspection robot is caterpillar type. In
work in 300 to 500 mm diameter pipe with multiple elbows is [7,8], active caterpillar pipe inspection robots were proposed.
introduced in this paper. The robot consists of two modules- Caterpillar type robots for indoor pipe inspection were
active module and passive module. Each module has three wheel developed in [9,10]. Each type of these robots has advantages
configurations with different mechanism to expand the wheels. A and disadvantages that makes a particular type robot works
proportional integral derivative controller is designed for the best only in a certain condition. In addition, some researches
robot to follow reference linear velocity and reference angular about special mechanism for robot moving in the pipeline
velocity. Simulations and experiments are conducted to verify were proposed [11,12]. Control and driving algorithms was
performances of the proposed controlled robot. The results
also researched and developed to make pipe inspection robot
demonstrate that the robot with the designed controller can work
move effectively [13,14].
well by following the reference velocity.
A wheeled-type pipe inspection robot designed to work in
Keywords—Pipe inspection robot; wheeled-type; controller 300 to 500 mm diameter pipe with multiple elbows is
design introduced in this paper. The robot consists of two modules-
active module and passive module. Each module has three
I. INTRODUCTION
wheel configurations with different mechanism to expand the
Pipeline has been one of the effective and efficient wheels. A PID controller is designed for the robot to follow
transportations to transfer essential fluid things, such as water, reference linear velocity and reference angular velocity.
oil and gas from one place to other places. Therefore, pipeline Simulations and experiments were conducted to verify
has been used for such a long time and become popular until performances of the proposed controlled robot. The results
now because its cost is relatively low compared to other demonstrate that the robot with the designed controller could
transportation such as transportation vehicles. However, since work well by following the reference velocity. The
pipeline is made by metal, pipeline does not have long contribution of this paper over the literatures is that this paper
operating time, due to deterioration, corrosion, fluid leaking proposes a new design of pipe inspection robot that has active
and plugging that commonly happen after few years of and passive modules which are connected with universal joint
installation. Thus, regular maintenance is essential to prevent to enable the robot move in flexible ways.
these problems. However, since most pipelines are located
underground, it is difficult for humans to perform maintenance
in pipeline directly. There have been some ways developed to
help humans perform maintenance in pipeline.
Pipe inspection robots have been utilized widely to
perform maintenance in pipeline. In [1], seven kinds of in-pipe
robots used worldwide were reported. Pig type which is
usually used in oil and gas pipeline is passively driven by
liquid or gas passing through the pipe [2]. Another type of the
robot is wheeled type robots, which are generally used for
commercial purpose. Wheeled in-pipe inspection vehicles for
φ 25, φ 50, φ 150 pipes were designed in [3,4]. Wheeled pipe
robot system with active steering capability was developed for
internal inspection of urban gas pipelines in [5]. And in [6] Fig. 1. The designed pipe inspection robot.
wheeled differential drive inpipe robot was developed for
navigation inside pipeline.
978-1-4799-3080-7/14/$31.00 2014
c IEEE 789
II. CHARACTERISTICS OF ROBOT Fig. 4 depicts the structure design of the passive module.
Passive module has similar structure with the active module.
A. Structure Instead of thread shaft in the active module, compression
The designed robot consists of two modules, namely active spring is used for expansion and contraction of 4-bar linkage
and passive modules. The active term refers to the use of in the passive module. This is because pipe inspection robot
motor to expand and contract the wheels, whereas the passive only needs one active mechanism module to work in pipelines.
term refers to the use of spring. The active module is used for
giving pressure to the wall so that robot can grip the pipe wall
especially moving in elbows or vertical pipe. On the other
hand, the passive module is used to support the active module
in case that the active module could not move in some
conditions such as moving through elbow, and/or passing
through choked section in pipeline.
Fig. 2 shows the structure design of the active module in
SolidWorks. This module consists of three wheel
configurations, a thread shaft, three 4-bar linkage, two gears
and a high power 33.5 W expansion motor to expand and
contract the wheels. Each wheel configuration consists of a
12.8 W DC motor for driving motor and rubber wheel sets. 4-
bar linkages are used to assure the robot to have strong grip on
Fig. 4. Structure of passive module.
the pipe wall as depicted in Fig. 3. Rubber wheels make the
wheel give bigger wall press forces. Expansion and
contraction of the 4-bar linkage is done by rotating the thread
shaft which is actuated by expansion motor and thus making B. Comparison of the Wheeled-Type Pipe Inspection Robot
the shaft holder move forward and backward. Shaft holder, as and Other Type Robots
shown in Fig. 3, is used to transfer energy from thread shaft to Comparison of wheeled type with other type of pipe
the 4-bar linkage. inspection robot is shown in Table I.
TABLE I. COMPARISON OF PIPE ROBOTS
Specification Value
vcz =
1
3
r
3
(
( v1 + v2 + v3 ) = θ1 + θ2 + θ3 ) (4)
Total weight 11 kg
The relationship between the input angular velocity vector
Length of active module 255 mm T
of wheels ș a = ª¬θ1 θ2 θ3 º¼ and the output velocity vector
Weight of active module 5.5 kg
T
Length of passive module 220 mm u = ª¬ω x ωy vcz º¼ is constructed as
Weight of passive module 4.5 kg
u = ª¬G ua º¼ ș a (5)
Total length of the robot 685 mm
Exterior diameter 300-500 mm
and the Jacobian is given as
Nominal speed 9 cm/s
Maximum speed 21 cm/s ª 3r 3r º
« 0 − »
Camera module length 135 mm « 3a 3a »
Serial communication device 15 m ªG a º = ∂u « 2r r r »
¬ ¼ ∂θ = « − 3a
u
(6)
a « 3a 3a »»
« r r r »
« 3 3 3 »¼
¬
ª e1 º ªωrx º ªω x º
« » « »
e = ««e2 »» = «ωry » − «ω y » = u r − u (7)
«¬ e3 »¼ «v » « v »
¬ rcz ¼ ¬ cz ¼
T
where u r = ª¬ωrx ωry vrcz º¼ is reference velocity vector of
Fig. 5. The xyz definition in pipe inspection robot.
the robot.
at the center of the pipeline inspection robot. iˆ , ĵ , and k̂ are
the unit vectors of the local coordinate frame. The x-axis is The tracking error of the input angular velocity vector of
always in parallel with P1 regardless of how the robot moves, the wheel is defined as:
where P is normal force of the pipe wall to the wheel.
ª eθ 1 º ªθ1r º ªθ1 º
By assuming that linear velocities of all wheels v1, v2, and « » « »
v3 exist at the same time, the total rotational velocity vector of eθ = ««eθ 2 »» = «θ2 r » − «θ2 » = ș ar − ș a (8)
the robot is obtained by: «¬ eθ 3 »¼ «θ3r » «θ3 »
¬ ¼ ¬ ¼
ω = ω x iˆ + ω y ˆj (1)
where where ș ar is the input angular velocity reference.
3r 3r The relation between eș and e is given by
ωx = θ2 − θ3 (2)
( )
3a 3a −1
and eș = Gua e (9)
2r r r
ωy = − θ1 + θ2 + θ3 (3) The DC motor system is shown in Fig. 6. The system state
3a 3a 3a
variable vector is chosen as
T
r is radius of the wheels and a is the distance from the center Į = ª¬i a ș a º¼ (10)
of the robot to the center of the wheel. ω x and ω y are angular
velocity vectors of the robot in x and y axes, respectively.
θ1 , θ2 , and θ3 are input angular velocities of the three wheels. where i a = [i1 i2 i3 ] is current vector on motor and i1 , i2 ,
T
The linear velocity at the center of the robot is obtained by and i3 are currents on motor 1, motor 2, and motor 3,
taking the average of linear velocities of the wheels as respectively.
Į = AĮ + Bv m (11)
ª vm1 º
de
v m = ««vm 2 »» = K p eθ + K I eθ dt + K D θ
³ (12)
dt
«¬ vm3 »¼ Fig. 9. Elbow and pipe specification (mm).
where K p , K I , and K D are 3x3 diagonal matrices, and v m is TABLE III. PARAMETER AND INITIAL VALUES
motor input voltage vector of the wheel motor. Parameter Value Unit
L 0.1 H
Block diagram of the proposed PID controller is shown in
Fig. 7. Kφ 0.3 -
J 0.1 Kg.m2
b 0.01 -
e eθ vm ș u R 2 ȍ
u r (G ua ) −1 G ua
r 47.45 mm
a 102.55 mm
ia [ 0 0 0 ]T A
Fig. 7. Block diagram of the proposed controller.
u [ 0 0 0 ]T [rad/s rad/s mm/s]T
ș [ 0 0 0 ]T rad/s
a
IV. SIMULATION RESULTS
Simulations were done to verify the proposed controller and its inverse matrix is
performances. A pipeline used for simulation and experiment ª 0 −2.16 0.021º
is shown in Fig. 8 and its dimension is shown in Fig. 9. The −1
parameter values used in the simulation are listed in Table III.
ªG ua º
¬ ¼ = «« 1.87 1.08 0.021»»
«¬ −1.87 1.08 0.021»¼
By subtituting r = 47.45 mm and a = 102.55 mm to (6), the
Jacobian matrix becomes
Likewise, by using motor parameters in Table III, A and B
ª 0 0.267 −0.267 º
in (11) can be calculated.
ªG ua º = « −0.309 0.154 0.154 »
¬ ¼ « »
¬« 15.82 15.82 15.82 ¼»
B. Control Process
For control process, C# and AVR ATmega are used for
GUI and motor driver control, respectively. For monitoring
using the camera, built-in software VIJE Savitmicro is used as
shown in Fig. 21 which also shows the display of C# GUI.
There are three parts in the GUI, i.e. camera control panel
where users control the camera directions, camera vision
Fig. 17. Collaborative structure between two modules information window that displays images taken by camera,
The robot working principle is relatively straightforward and robot control panel to control the robot motion. In the
since a computer with a Graphic User Interface (GUI) is robot control panel, there are three buttons, namely backward,
provided for users to control the robot manually and obtain stop, and forward. These buttons simply control the robot to
vision information inside the pipe. Fig. 18 shows a flow chart move forward and backward. The PWM value that is sent to
of how the robot works. Control order which is given by users motors is displayed at the three left bottom boxes, whereas the
in GUI is sent to Atmega 8. Then, Atmega 8 translates it into PWM value that is read by encoders is shown at the right
Pulse Width Modulation (PWM). After that, DC Motor is bottom boxes.
actuated by this signal and finally the robot is driven by the
DC motor. Information data inside the pipe is obtained from VI. EXPERIMENTAL RESULTS
two sensors, i.e. camera and encoder. By using the encoder,
position of the robot can be examined. Fig. 19 shows the Experiments were conducted to verify performances of the
picture of the whole pipeline inspection robot system that designed robot and the proposed PID controller. The
mainly consists of a robot device and a control system. The experiment was conducted by making the robot following the
control PC is used to display GUI and vision information reference velocities that was made previously in the
obtained from camera. The motor control module consists of simulation. The result shows that the proposed PID controller
multipoint control unit (MCU) printed circuit board (PCB) could make the robot go through the pipe successfully by
(Atmega 8), a motor driver PCB and a sensor processor (AVR) following the reference velocities in horizontal straight and
as shown in Fig. 20. elbow pipelines.