Professional Documents
Culture Documents
By
ABSTRACT
Line tracking and obstacle avoidance behaviors are the critical challenge in the creation of autonomous mobile robots. Mobile robots must be able to operate within normal environments to carry out different tasks, such as banks surveillance and transportation of goods without any human intervention. This report describes the design and development of an autonomous mobile robot which exhibits line tracking and obstacles avoidance behaviors. The PI !"#$%%& microcontroller has been chosen as the brain to control the system. There are ' types of software that are used in programming development which are MPL&( Integrated )esign *nvironment +I)*, and -I.T* - PI language and the -I.T* - PI Lite Lite ompiler software. MPL&( I)* software is used to program the PI !"#$%%& microcontroller in ompiler is used to convert source code into machine instructions. Tracking system is developed for the mobile robot to have navigation ability. /ensor arrays that are used will be able sense a line and maneuver the robot to stay on course, while constantly correcting its position using feedback mechanism forming a simple yet effective closed loop system. ontact detection approach is used in this pro0ect in order to avoid the mobile robot from colliding with obstacles. The testing phase results had shown that successful programming algorithm had been implemented. /everal suggestions of improvements to the robot have been recommended from the observation at the end of the report.
ABSTRAK
Pembangunan robot bergerak yang memiliki kemampuan untuk menuruti satu laluan dan mengelak sebarang halagan merupakan satu cabaran yang agak kritikal. 1obot bergerak ini perlu ada sifat.sifat tersebut bagi menghadapi manusia di sekelilingnya semasa beroperasi, sekiranya ia ditugaskan untuk men0alankan ker0a seperti mengawasi keselamatan bank dan mengangkat barang.barangan. Laporan ini membentangkan sebuah rekabentuk dan pembangunan sebuah robot bergerak yang boleh mempamerkan kebolehan untuk menuruti satu garis laluan dan mengelak sebarang halangan yang telah dikesan. Microcontroller PI !"#$%%& telah dipilih untuk mengawal sistem yang telah digunakan. )ua 0enis perisian telah digunakan dalam pembangunan pengaturcaraan iaitu MPL&( Integrated )esign *nvironment +I)*, dan -I.T* - PI Lite ompiler. /istem pen0e0akan dibangunkan untuk membolehkan pelayaran robot. )engan susunan penderia yang digunakan, ia akan mengesan dan memandu robot tersebut sentiasa di dalam kedudukannya sementara ianya berterusan dengan bantuan sistem maklum balas atau gelung tertutup yang mudah dan berkesan. Pengesan sentuhan digunakan di dalam pro0ek ini adalah untuk tu0uan mengelak pelanggaran. -asil daripada fasa u0ian yang telah ditun0ukkan adalah algoritma pengaturcaraan telah dilaksanakan. (eberapa cadangan untuk penambahbaikan robot akan diusulkan setelah membuat pemerhatian akan dinyatakan di akhir laporan ini.
ii
CHAPTER 1
INTRODUCTION
1.1
Background
Robot is the one of technology that is growing rapidly in our modern world. We can see that, the utilization of robot today had being widely used in various fields. The robot can be used either to aid in human duty or replace the use of human to do a certain works. For example, robot has already widespread used in the industry especially in manufacturing sector where it used to replace the use of manpower in lifting heavy material or assembling part in production line. t may be caused by several factors such as may increase productivity, enhance !uality and also can perform a dangerous task. Robot can defined as a mechanism which moves automatically and be able to deal with the changing information received from its environment. "enerally, robots have three main parts known as actuators, sensors and controllers. #ensors are devices that used to detect information from it$s environment. These detected information or input information are transformed into electrical signals and its will send to the controller. The controller processes the inputs by executing the functions of operation that have been programmed such as start, stop, reverse and speed change. The output signals that have produced by controller are conveyed to the actuators to perform a desired operation. Within all these part we can conclude that the robot have similar characteristics to human. Figure %.% shows the similarity of feature between human and robot.
1.2 Prob e! "#a#e!en# #ensor is one of the important components in line tracking robots. t is because the skills of line tracking robots are highly dependant on the effectiveness of the sensor. #urrounding light could make the sensor produce a signal whereas it shouldn$t. This will cause the controller to make a wrong decision. )s a result the robots will make unnecessary movement and can$t achieve it$s ob*ective. The contrast between the background and the line can also cause a problem to the sensor. The sensor may detect the background as its line thus making a wrong decision. This pro*ect will also consider of noise which is produced by electric dc motor. The motor that will be used may be able to contribute imbalance to the + , microcontroller. -oise or interference consists of unwanted electrical signals which imposes on and masks the desired signal. -oise is always present in a system that involves high power and small signal circuitry. The source of the noise could be from the switching of the driver circuits or the motor itself. nternally, the relatively high current motor drivers are the source. .lectrical unbalance occurs when the magnetic attraction between stator and rotor is uneven around the periphery of the motor. This causes the shaft to deflect as it rotates creating a mechanical unbalance. .lectrical unbalance usually indicates an electrical failure such as an open stator or rotor winding, an open bar or ring in s!uirrel
cage motors or shorted field coils in synchronous motors. )n uneven air gap, usually from badly worn sleeve bearings, also produces electrical unbalance.
%.0 Pro$ec# Ob$ec#i%e& The main aim of this pro*ect is to design an autonomous line tracking robot with the ability to avoid obstacle. This aim is achieved through these ob*ectives1 %. To design and build the structure of an autonomous robot. /. To construct suitable electronic circuits and integrate them with the robot structure. 0. To program the + , to achieve line tracking and obstacle avoidance behavior.
1.' "co(e n order to design a successful autonomous robot, scopes are re!uired to assist and guide the development of the pro*ect. The scope should be identified and planned to achieve the ob*ective of the pro*ect successfully on the time. The first scope for this pro*ect is literature study on *ournals or books that related with the pro*ect. The purpose of literature study is to find all information which can help in completing this pro*ect. The next scope in this pro*ect is design and fabricates of body structure for the mobile robot. This pro*ect will be more focused on the construction of electronic circuit which uses a + , microcontroller to control the motion of the robot. n order to make the robot performs the desired task2 a programming development will be executed.
1.) Pro$ec# O%er%ie* The goal of this pro*ect is to design an autonomous robot that can follow the defined path and detect obstacles. The concept of this robot is a wheeled robot that can move in two directions1 forward and backward. The movement of the robot will be driven by two motors. )s a path guideline, white line is created on the dark floor in order to make the contrast between of them should be large enough. n this pro*ect, the photoelectric sensors will be used to detect the white line and then convert into the electrical signal. There are four sensors will be used where three of them are placed close together at the front side of the robot and one sensor at the backside of the robot. f the middle sensor at the front side and the sensor at the backside sense a presence of reflection, the robot will be properly positioned on the line. f the left or the right sensor sense a presence of reflection, the robot is not proper position on the line. n order to control these statements, the + , controller is used to make a decision whether the motors should be move forward or backward depending on the instruction that have been programmed. 3ther feature of this robot is detecting the obstacle on the path. This feature is developed in order to avoid the robot from collusion with an obstacle and protect the motor from stalling. This chapter describes the problem statement, ob*ectives, pro*ect scope and overview of the pro*ect. ,hapter / will describes more detail the fundamentals of mobile robots and its involved component. This chapter also explained about types of mobile robot navigation and previous studies on the performance of the mobile robots published in books and *ournals. While in the chapter 0 will presents the planning process from the beginning till the pro*ect completed. This report also includes the discussion and conclusion in the chapter 4 and 5.
CHAPTER 2
LITERATURE REVIEW
2.1
Introduction to Robot
Nowadays, majority of public have known what is robot. This is because, we can see that the robot already much used around our environment especially in industry, house, office and also military. However, the word of robot was introduced to several decades ago. The word robot is originated from the word Chez robota which means menial labor. e also found that there were many difference definitions if we refer to difference dictionaries. Therefore, the following definition from the !obot "nstitute of #merican can reflect main features of modern robot systems $%&. 'A Robot is a re- programmable multifunction manipulator designed to move materials, parts, tool, or specialized devices through variable programmed motions for performance of a variety of tasks.($%& #ccording to the above definition, we can say that the robot is the machine that used to carry out a variety of task such as transfer the material from one location to another. The robot that performs their tasks is depending on the motions that have been programmed. The re) programmable multifunction is the most important feature in order to make the robot more adaptable to the task change.
2.2
Robot Categories
hen looking different kind and design robot which have been produced by various companies today, we could classify these robots into * main categories which are industrial robots and mobile robots.
means the ma+imum point of reach for the end)effector of an industrial robot. 3sually, the work)space of industrial robots e+ists in 4 dimensional spaces. They also have a different work)space according to the * type of motion which are linear and rotate. The first 4 joint at the robot or called 4 major a+es combination contribute the various shape of work)space and its can determine the position of wrist. Therefore, statements below will describe the 5 basic types of movement of industrial robot $4&. Cartesian Co-ordinate Robot The first 4 major a+es combination of this robot are linear. This robot is mounted in * ways either gantry mounted usually for a large Cartesian robot or mounted on track on the floor. "t(s sometimes called an +)y)z robot, indicating the a+es of motion. The +)a+is is lateral motion, the y)a+is is longitudinal motion, and the z)a+is is vertical motion. Thus, the arm can move up and down on the z)
a+is7 the arm can slide along its base on the +)a+is7 and then it can telescope to move to and from the work area on the y)a+is. The Cartesian co)ordinate robot was developed mainly for arc welding, but it is also suited for many other assembly operations $%&.
ork)8pace $%9&
Cylindrical Co-Ordinate Robot The cylindrical co)ordinate robot is a variation of the Cartesian robot. This robot consists of a base and a column, but the column is able to rotate. "t also carries an e+tending arm that can move up and down on the column to provide more freedom of movement. The cylindrical co)ordinate robot is designed for handling machine tools and assembly $%&.
ork)8pace $%9&.
Polar Co-Ordinate Robot The polar co)ordinate robot or spherical co)ordinate robot consists of a rotary base, an elevation pivot, and a telescoping e+tend)and)retract boom a+is. These robots operate according to spherical co)ordinates and offer greater fle+ibility. They are used particularly in spot welding $%&.
ork)8pace $%9&.
Articulated Co-ordinate Robot The articulated co)ordinate robot is resembles to a human arm. "t usually stands on a base on which it can rotate, while it can articulate at the <shoulder< joint, which is just above the base. The robot can also rotate about its <elbow< and <wrist< joints. The articulated co)ordinate robot is the most popular form for a robot and is capable in welding and painting work $%&.
ork)8pace $%9&.
smoothly and can avoid from obstacle without collision. The selections of navigation for the mobile robot should be corresponding with the environment that the robots travel. There are * main types of environment which are indoor and outdoor. =evelopment of outdoor robot is usually more difficult than indoor robot $>& $0&. 8ometimes, this robot is also used to perform other purposes such as pick up the goods and put down the goods at other places. The place that robot takes the goods can be called starting point and place that robot places the goods can be called target point. 8o, we can say that the purpose of the use of mobile robot may be same as the fi+ed robot but the size of work)space and their capability are differences. This kind of robot is also very important to industries. The mobile robot can eliminate the use of man power in lifting the heavy material from store to production line. The /igure *.0 illustrates an e+ample of mobile robot that is used to transport motor blocks from on assembly station to other. "t is guided by an electrical wire installed in the floor but it is also able to leave the wire to avoid obstacles. .esides that, the mobile robot can do a job in unsafe area such as e+posed to e+cessive temperatures or in nuclear plant. The mobile robot can also appear as consumer products, for entertainment or to perform certain tasks like vacuum cleaning $0&.
%9
%%
?b@ Moving on or in
ater There are two types of mobile that are move on surface of
the water and move underwater. The mobile robot that travels on water can call as robotic boat. The robotic boat can comes in various size of canoe and it is propelled by an electrical backboard motor. The motor has power enough to run it with a speed of few knots. #lthough propeller is commonly used propulsion device in boats, it should be noted that energy efficiency is usually poor. This is due to the force component of the rotating propeller, which is perpendicular to the propulsion a+is and is fully lost in the propulsive power $5&. #nother type is underwater robot where the mobile robot can move in water. B+ample for this type is !obo Tuna where the shaped of body is like a real tuna fish and the propulsion is generated by actuating the body with wire driven by motors. The motion imitates the corresponding fish swimming motions $5&.
Figure 2.( #utonomous 3nderwater Cehicle $%*&. ?c@ Moving on airA 3sually, mobile robots that can move on air are called as pilotless aircraft. These types of robots are increasingly used in military applications especially for reconnaissance purposes. ,any of these systems are deployed in a remotely)operated mode, that is, a human controller works interactively to move the mobile robot and position based on visual feedback from video or other types of sensors $%4&.
%*
%4
?+,y@. ,etric path planners have two components which are the data structure and the algorithm. =ata structure is means make a partition the world into a structure amenable for path planning. hile algorithm is generally work on almost any configuration space representation, although as with any algorithm, some methods work better on certain data structure. "n the metric navigation, the mobile robot uses a specialize sensors such as sonar sensor to create a new map on its local environment. Then, the new map will compared with the global map that previously stored in memory for updating its actual position. This navigation also uses shaft encoders to determine the location that robot has moved. The mobile robot is also being able to learn an une+plored environment and improve its $4&.
*.4
"n order to develop an autonomous mobile robot, there are three major components that are involved which are electric motor, sensor and microcontroller. The functions of these components are related with each other.
%5
2.".1.1/C %otor
Figure 2.0 =C ,otor $%>&. =c motor is common device that used in industrial application. This type of motor is known as dc motor because it supplied with direct current source. /igure *.%9 illustrates the construction and components of a dc motor. The stationary outer housing, called the stator, supports radial magnetized poles. These poles consist of either permanent magnets or wire coils, called field coils, wrapped around laminated iron cores. The purpose of the stator poles is to provide radial magnetic fields. The iron core intensifies the magnetic field inside the coil by increasing the permeability. The purpose for laminating the core is to reduce the effects of eddy currents, which are induced in a conducting material $%5&. The rotor consists of a rotating shaft supported by bearings, an iron core into which winding are anchored, and, in dc motors, a commutator to deliver current and control its direction in the rotor windings. The rotor and its windings are sometimes referred to as the armature. /or motors with a commutator, the brushes provide stationary electrical contact to the moving commutator conducting segments. .rushes in early motors consisted of bristles of copper wire fle+ed against the commutator but now they are usually made of conducting solid graphite that provides a larger contact area and is self) lubricating. The brushes are usually spring)loaded to ensure continual contact between them and the commutator. There are small air gap between the rotor and the stator where the magnetic fields interact $%5&.
%>
Figure 2.11 ,otor Construction and Terminology $%5&. Tor-ue is produced by an electric motor either through the interaction of stator field and armature currents or through the interaction of stator fields and armature fields. /igure *.%% illustrates a dc motor with si+ armature windings. The direction of current flow in the windings is illustrated in the figure. The interaction of the fi+ed stator field and the currents in the armature winding produce a tor-ue in the clockwise direction. These tor-ue directions can verify by applying the right hand rule to the stator field and armature currents directions. To maintain the tor-ue as the rotor rotates, the spatial arrangement of the armature currents relative to the stator field must remain fi+ed. # commutator performs this task by switching the currents in the armature windings in the correct se-uence $%5&.
%0
/igure *.%* illustrates an e+ample of a commutator. "t consists of a ring of alternating conductive and insulting materials connected to the rotor windings. Current is directed through the windings via the brushes, which slide on the surface of the commutator. "n the position as shown in figure *.%*, current flows through windings #, ., and C in the clockwise direction and through /, B, and = in the counterclockwise direction. hen the rotor turns %F0 of a full rotation from it(s position, the currents in the windings C and / will switch directions. #s the brushes slide over the rotating commutator, this process continues in se-uence. ith appropriate windings configurations, the commutator maintains a consistent spatial arrangement of the currents relative to the fi+ed stator fields, resulting in a constant clockwise tor-ue $%5&.
Figure 2.12 Blectric ,otor 8i+) inding Commutator $%5&. #nother method by which electric motors can create tor-ue is through interaction of stator and rotor magnetic fields. The tor-ue is produced by the fact that like field poles attracts and unlike poles repel. /igure *.%4 illustrates this principle of operation with a simple two)pole dc motor. The stator poles generate fi+ed magnetic field with permanent magnet or coils carrying dc current. The winding in the rotor is commutated to cause changes in direction of its magnetic field. The interaction of the changing rotor field and fi+ed stator fields produce a tor-ue on the shaft, causing rotation. ith the rotor in posotion ?i@, the right brush contacts commutator segment # and the left brush contacts segment ., creating a current in the rotor winding, resulting in the magnetic poles as shown. The rotor magnetic poles oppose the stator magnetic poles, creating a tor-ue
%6
causing clockwise motionof the rotor. "n the position ?ii@, the stator poles both oppose and attract the rotor poles to enhance the clockwise rotation. .etween positions ?iii@ and ?v@ the commutator contacts switch, changing the direction of the rotor current and hence the direction of the magnetic field. "n the position ?iv@, both brushes temporarily lose contact with the commutator, but the rotor continues to move due to its momentum. "n position ?v@, the reversed magnetic field in the rotor again opposes the stator field, continuing the clockwise tor-ue and motion $%5&.
%:
Figure 2.1# .rushless =C ,otor $%0&. #nother type of dc motors is the brushless dc motor. The most widely used look much like brush)type motors. .ut brushless motors have a wound stator that surrounds a permanent)magnet rotor, an inverse arrangement from that for brush motors. #nd stator windings are commutated electronically rather than through a conventional commutator and brushes. .rushless motors generally contain a three)phase winding, although some operate four phase. .rushless motors powering small fans and other constant)speed e-uipment are often two phase. .ecause they have no commutator, brushless motors are more efficient, need less maintenance, and can operate at higher speeds than conventional dc motors. High efficiency and small size are especially important for military, aircraft, and automotive applications, and for portable instruments and communications e-uipment $%:&. #mplifiers for brushless motors are more comple+ than brush types and generally call for two additional solid)state power switches. These switches account for most of the cost differential between the two types. .ut switch cost continues to drop, in part because of increased use of ,G8/BT and insulated)gate type switches. Costs also are dropping for "Cs used in commutation, feedback interpretation, and ; , circuits. The lower costs reduce but do not eliminate the price differential between amplifiers for the two types of systems $%:&.
%2
2.".1."4te**er %otor
Figure 2.1$ 8tepper ,otor $%6&. # special type of dc motor known as a stepper motor is a permanent or variable reluctance dc motor that has the following performance characteristic such as rotation in directions, precision angular incremental changes, repetition of accurate motion and capability for digital control. "t can move in accurate angular increments known as steps in response to the application of digital pulses to an electric drive circuit from digital controller. The number and rate of the pulse control the position and speed of the motors shaft $%>&. Henerally, stepper motors are manufactured with steps per revolution of %*, *5, 6*, %55, %:9, and *99, resulting in shaft increments of 49, %>, >, *.>, *, and %.: per step. 8tepping motors can be used in simple open)loop control systems7 these are generally ade-uate for systems that operate at low accelerations with static loads, but closed loop control may be essential for high accelerations, particularly if they involve variable loads. "f a stepper in an open)loop control system is over tor-ues, all knowledge of rotor position is lost and the system must be reinitialized. 8tepping motors can also be used in closed loop systems with the addition of an encoder and feedback drive circuitry. ;erformance is improved at the e+pense of additional cost $%>&.
*9
2.".1.#4er,o %otor
Figure 2.1& 8ervo ,otor $*9&. # servomotor is a small device that contains a three wire =C motor, a gear train, a potentiometer, an integrated circuit, and an output shaft bearing. The 4 wires that stick out from the motor casing are for power supply, ground, and control input line. The shaft of the servo can be positioned to specific angular by sending a coded signal. #s long as the coded signal e+ists on the input line, the servo will maintain the angular position of the shaft. "f the coded signal changes, then the angular position of the shaft changes. 8ervos are constructed from 4 basic component are that a motor, a potentiometer and a control board. The potentiometer is fed into the servo control circuit and when the control circuit detects that the position is correct, it will stops the motor. "f the control circuit detects that the angle is not correct, it will turn the motor the correct direction until the angle is correct. Normally a servo is used to control an angular motion of between 9 and %:9 degrees. The amount of power that applied to the motor is proportional to the distance that needs to travel. 8o, if the shaft needs to turn a large distance, the motor will run at full speed. "f it needs to turn only a small amount, the motor will run at a slower speed. This is called proportional control $%2&.
*%
2.".2 4ensor
#nother component that will be used is sensor. 8ensor is a device that measures some attribute of the world. 8ensors are also referred to as transducers. 8ensor receives energy and transmits a signal to a display on a computer. 8ensors use transducers to change the input signal such as sound, light, pressure, and temperature into an analog or digital form. "n addition, sensors are used to translate a physical phenomenon into acceptable signal that can be analyzed for decision making. #ctually, sensors are classified depends on the measurement purpose such as position, distance, force, strain, temperature, vibration, and acceleration. However, this section describes the sensors that are related with the development of the mobile robot such as sonar sensor, infrared and tactile. $4&.
*.4.*.% 4onar or Ultrasonic 8onar is one of the pro+imity sensor where using sound to measure range. 8onar for different application operate at different fre-uencies7 for e+ample, a sonar for underwater vehicles would use a fre-uency appropriate for traveling through water, while a ground vehicle would use a fre-uency more suited for air. Hround vehicles commonly use sonar with an ultrasonic fre-uency. This type of sensor is classified as active sensors which emit a sound and measure the time it takes for the sound to bounce back. The time of flight along with the speed of sound in that environment is sufficient to compute the range of the object.
**
Figure 2.1' 8onar Transducer $4&. # robotic sonar transducer is shown in figure *.%6. The transducer is about the size and thickness of a coin, and consists of a thin metallic membrane. # very strong electrical pulse generates a waveform, causing the membrane on the transducer to produce a sound. The sound is audible as a faint clicking noise. The reflected sound vibrates the membrane which is amplified and the threshold on return signal strength7 if too little sound was received, and then the sensor assumes the sound is noise and ignores it. "f the signal is strong enough to be valid, the timer is tripped, yielding the time of flight $4&.
*4
#lthough the sensors are ine+pensive, fast, and have a large operating range, ultrasonic sensors have many shortcomings and limitations which should be aware of such as specular reflection foreshortening and cross)talk. 3ltrasonic sensors rely on reflection, and so are susceptible to specular reflection. /igure *.%: ?b@ shows the specular reflection occurs when the wave form hits a surface at an acute angle and the wave bounces away from the transducer. "deally all objects would have a flat surface perpendicular to the transducer. The other side, if the sonar has a 49 degree field of view, it means that sound is being broadcast in 49 degree wide cone. The foreshortening problem occurs when the surface is not perpendicular to the transducer. /igure *.%: ?a@ shows one side of the cone will reach the object first and return a range first. #nother problem is the receiving sonar is unable to tell the difference between sound generated by itself or its peers. /igure *.%: ?c@ shows the problem where it is called cross)talk, because the sound waves are getting crossed and then procures a wrong reading $4&.
2.".2.2In!rared 4ensor
Figure 2.10 "nfrared 8ensor $**&. "nfra red sensor is one of the pro+imity sensors. "n an infra red sensing system, there are two important components which are emitters and receivers. /igure *.%: shows the emitter is used to emit infrared light to an object and the receiver is used to pickup the reflection from the reflective object. "nfrared radiation e+ists in the electromagnetic
*5