Supervisor: Dr. Bashir Nouri Prepared By: Manar Mohammad Sa’id Deema Abd-Rahman Odeh Rola "Mohammad Eid" Sabbah AN-NAJAH NATIONAL UNIVERSITY FACULTY OF ENGINEERING DEPARTMENT OF MECHATRONICS ENGINEERING CONTROL OF MOBILE ROBOT 1 1 Outlines Introduction System Structure Modeling of Mobile Robot Programming and Testing Control of DC Motor Fuzzy Controller Conclusion 2 2 System Structure Component DC motor Wheels Sensor :Ultrasonic Sensors Measurement devices 3 Modeling of Mobile Robot Modeling of Mobile Robot A description of a system using mathematical concepts . 4 5 Mobile robots Instantaneous Center of Rotation (ICR) Control of DC Motor Case 1: Field current controlled DC motor The air gap flux (φ) is proportional to the field current (if) as follows: 6 Case 2: Armature controlled DC motor DC Motor Speed P-Controller Step response with P controller 7 PID Controller This transfer function writes in S-domain as: The equation for the output in the time domain is : 8 PID Controller PID controller with large KI and large KD 9 Kp=100 Ki=200 Kd=10 Root Locus Controller Design 10 Closed-loop transfer function Bode diagram for transfer function related with velocity and angle 11 Root Locus Controller Design 12 Closed-loop transfer function –PID Controller Testing and Programming 13 Testing and Programming 14 Testing and Programming 15 Test and Programming 16 Fuzzy Controller 17 Mobile Robot avoiding obstacle and reach to the goal 18 19 Thank you for your attention Any questions? image2.png image3.jpeg image4.emf Y V X o X o X L ᶿ1 ᶿ2 image5.emf L 1 L 2 D w W L T w a b c d BF so j image6.png image7.png image8.png image9.png oleObject1.bin V Xo Xo X Y L ᶿ1 ᶿ2 oleObject2.bin a b L1 L2 Dw W L Tw c d B F s o j image10.emf P(t)+t P(t) V W ICR R C ᶿs image11.png oleObject3.bin P(t)+t P(t) V W ICR RC ᶿs image12.png image13.png image14.png image15.png image16.png image17.png image18.png image19.png image20.png image21.png image22.png image23.png image24.png image25.png image26.png image27.png image28.png image29.png image30.png image31.png image32.png image33.png image34.png image35.emf obstacle Mobile Robot image36.emf Fuzzy Rule Base Fuzzy Inference Engine DefuzzifierFuzzifier X in UY in V Fuzzy sets in U Fuzzy sets in V oleObject4.bin obstacle Mobile Robot oleObject5.bin Fuzzy Rule Base Fuzzy Inference Engine Defuzzifier Fuzzifier X in U Y in V Fuzzy sets in U Fuzzy sets in V image37.png /docProps/thumbnail.jpeg