Simulation of A Differential-Drive Wheeled Mobile Lego Robot Mindstorms NXT.

(1)

(2)

APPLIED MECHANICS AND MATERIALS

"Applied Mechanics and Materials" publishes only complete volumes on given topics, proceedings and complete special topic volumes. We do not publish stand'alone papers by individual authors.

"Applied Mechanics and Materials" specializes in rapid publication of proceedings of

international scientific conferences, workshops and symposia as well as special volumes on topics of contemporary interest in all areas which are related to:

1) Research and design of mechanical systems, machines and mechanisms; 2) Materials engineering and technologies for manufacturing and processing; 3) Systems of automation and control in the areas of industrial production; 4) Advanced branches of mechanical engineering such as mechatronics, computer engineering and robotics.

Authors retain the right to publish an extended, significantly updated version in another periodical.

Volumes are submitted for indexing to

Index Copernicus Journals Master List www.indexcopernicus.com. Google Scholar scholar.google.com.

Cambridge Scientific Abstracts (CSA) www.csa.com.

Inspec (IET, Institution of Engineering Technology) www.theiet.org. SCImago Journal & Country Rank (SJR) www.scimagojr.com.

EBSCO www.ebsco.com.

Thomson Reuters (WoS), all volumes are submitted and selected ones will be indexed.

Please ask for additional information: amm@ttp.net

Irregular: approx. 30'50 volumes per year.

The subscription rate 2016 for

Standing order price: 20% discount off list price

(3)

!

Huaqiao University, Ministry of Education Engineering Research Center for Brittle Materials Machining; Xiamen, China, 361021;

!

University of Applied Sciences of Southern Switzerland, Dynamat Laboratory; Via Trevano P.o. Box 12,

Canobbio, 6952, Switzerland;

Harbin Institute of Technology, School of Materials Science and Technology; P.O. Box 435, Harbin,

China, 150001;

Yurga Institute of Technology of National Research Tomsk Polytechnic University; Leningradskaya

Street, 26, Yurga, Russian Federation, 652055;

Slovak University of Technology in Bratislava, Faculty of Materials Science and Technology in Trnava;

Bottova 25, Trnava, 917 24, Slovakia;

Gheorghe Asachi Technical University of IaHi, Department of Machine Manufacturing Technology; D. Mangeron Blvd, 39A, IaHi, 700050, Romania;

Clermont Université, Pascal Institute; UMR 6602 CNRS/UBP/IFMA, BP10448, Clermont'Ferrand, F' 63000, France;

!

Technical University of Kosice, Department of Production Systems and Robotics, Faculty of Mechanical

Engineering; Letná 9, Kosice, 042 00, Slovakia;

" # !

Université de Toulouse, INPT ' Ecole Nationale d’Ingénieurs de Tarbes (ENIT), LGP (Laboratoire Génie

de Production); 47 Avenue d’Azereix, BP1629, Tarbes Cedex, 65016, France;

" $ %

Technical University of Kosice, Faculty of Mechanical Engineering, Department of Production Systems

and Robotics; Nemcovej 32, Kosice, 042 00, Slovakia;

" & ' (

Technical University of Košice, Department of Technical Devices Design; Štúrova 31, Prešov, 08001,

Slovakia;

% & !

University of Glasgow, Department of Mechanical Engineering; Glasgow, United Kingdom, G12 8QQ;

(4)

Malaysian Nuclear Agency Bangi, Materials Technology Group (MTEC), Industrial Technology Division; Kajang, Malaysia, 43000;

Politehnica University of Bucharest; Splaiul Independentei 313. Sector VI, Bucharest, 060042, Romania;

# &

TU Kosice, Faculty of Manufacturing Technologies; Bayerova 1, Presov, 08001, Slovakia;

) *"

Friedrich'Alexander'Universität Erlangen'Nürnberg, Institute for Factory Automation and Production Systems; Egerlandstraße 7'9, Germany;

+ (

AGH University of Science and Technology, Department of Robotics and Mechatronics, Faculty of Mechanical Engineering and Robotics; Al. Mickiewicza 30, Krakow, 30'059, Poland;

,

Universiti Kebangsaan Malaysia, Department of Mechanical and Materials Engineering, Faculty of

Engineering and Built Environment, Centre for Automotive Research, Faculty of Engineering and Built

(5)

$ #%& ! % # / # ' 6 ! * / % !# * ! &# ! "/ %6

Experimental and Theoretical Investigation of Bolted Bamboo Joints without Void Filled Material

" # $ %& ' ( ) * + ' ( * ' ( * &

Chapter 1: Technologies of Sustainable Development in Civil Engineering, Transportation and Urban

Planning

Abstract:An experimental and theoretical are presented to calculate the load capacity of shear single

connection (SSC) and shear double connection...

,-The Significant Importance to Measure Road Safety

(6)

Chapter 1: Technologies of Sustainable Development in Civil Engineering, Transportation and Urban Planning

Abstract:Although road safety is a huge problem in develop and developing countries, road safety measures are not implemented seriously yet,...

Accessibility to Location of Activities in Denpasar City, Bali'Indonesia

" / " +

Abstract:Denpasar City is the capital of Bali Province with the population of about 0.9 million. Denpasar City has experienced high increase in...

Travel Time Estimation Based on Spot Speed with Instantaneous and Time Slice Model

" $(0( $ " "' ( ! ' (1( 2 *

Planning

Abstract:In off'line applications, travel time is the main parameter of road performance which can be

the main consideration for evaluation and... 3

Port Location Selection Model: Case Study of Tourism Sector in Bali

" 4 & $ + ! " ' ) " ' 56 " $

Planning

Abstract:We employ an integrated model to decide the location of the most optimum harbor

infrastructure of tourism in determining the tourism...

Determining Passenger Car Equivalent for Motorcycle at Mid'Block of Sesetan Road

" ( # 4 & /

Abstract:Motorcycle dominates traffic in Bali, particularly in urban roads, which occupy more than 85% of mode share. The three types of vehicles,...

-,

Readiness Criteria: Indonesias’ New Initiative to Ensure Sustainable Development Program

(7)

Abstract:Government of Indonesia through Ministry of National Development Planning/Head of BAPPENAS, recently launched a new initiative in regard to...

3

Conceptual Framework of Bidding Strategy in Order to Improve Construction Project Performance

" ( + 7 " ' 0( ( 4 ' $ " 8 *

Planning

Abstract:Globalization makes the competition ofconstruction is increasingly tight. The competitors

faced not only in the regional district/city,... 3

The Conceptual Framework of Design Change Effects in Some Project Delivery Systems

" ( ( # 7 ' 0( ( 4 ' $( 8 *

Planning

Abstract:Changes will always occur in project construction and can not be avoided. Many factors can cause changes in the construction project. Most...

An Identification of Construction Project Overheads for Sustainable Cost Management and Controlling Practices (CMCPs)

" + $ " 1 + ' + 9 &

Planning

Abstract:Project overheads are allocated on a percentage basis to project costs and common to

maintain multiple cost objects, but cannot directly be..

Simulation of a Differential'Drive Wheeled Mobile Lego Robot Mindstorms NXT

" ( 8 + 8 " ' .(#( / " ' 7 (/( 8 + 4 :

Chapter 3: Advanced Decisions in Mechanical Engineering

Abstract:The aim of this paper is to model and simulate kinematics motion using the differential drive model of a mobile Lego robot Mindstorm NXT. The...

;

-Design and Simulation of Five Fingers Gripper for Dexterous Pick'Up Various of Components

" ( 8 + 8 " ' / * ' .(#( / " ' 7 (/( 8 + 4 :

(8)

Abstract:In this paper, the authors describe and demonstrate how a Five fingered gripper can be designed and simulated to provide both gross motion...

; ,

Tar Balls Collector for Mechanical Recovery in Combating Oil Spill on the Marine Environment

< " . & / $ " ' $ " 7 ' 5

Abstract:The impacts of oil spill on water pollution are more fatal than on the mainland because the spread of pollutants is larger and more massive....

;;

Three Wheel Bike as Physical Therapy Equipment for Post'Stroke Patient

" ( $ 2 ! ' 4 & ' $ " 4 = >

Abstract:Three wheel bike as a physical therapy equipment for post'stroke patients was designed with

length of 1937 mm, 1010 mm in width and height of... ;;

Geometric Progression Application in Design Transmission Gear Ratio

" ( ( ( ( ? * ' ( # ? ' ( ? &

Abstract:One of the important aspects in determining the competitiveness of an automotive product is

the traction ability or performance, the... ; ;

Role of Risk Management in Effective Maintenance

" 0 7 ' / 9 / *

Abstract:Every manufacturer requires plant maintenance. Knowing that an effective maintenance system increases sales and decreases maintenance cost of...

;

-Redesign Combustion Air Shelter of the Furnace to Improve the Performance in Melting Bronze for Manufacturing Gamelan

" ( # " / ' ( ? # ' ( ( ( ( ? * ' ? * ' (

8 + ! +

Abstract:Gamelan Bali is a set of Balinese traditional musical instruments used to accompany a series

of cultural and religious ceremonies or... ;,,

Model of Carbon Dioxide (CO2) Emission from Motorcycle to the Manufactures, Engine Displacement, Service Life and Travel Speed

(9)

Abstract:By the end of 2012 the population of motorcycle reached 77.7 million units with their

average composition on the road reached 82%. The number... ;

Experimental Study of Heat Transfer Characteristics of Condensed Flow on the Vertical Wave Plates

" 8 "+ 0( / "' @ + 56

Abstract:Studies on the heat transfer characteristics of vertical wave plate subjected to the condensed

steam had been done. This research was done to... ;

Forces Analysis on a Spherical Shaped Delivery Valve of Hydram Pump

" $

Abstract:Hydram pump has been found more than two centuries ago, and has been widely developed

(10)

Simulation of A Differential-Drive Wheeled Mobile

Lego Robot Mindstorms NXT

I Wayan Widhiada

1,a

_{, Cok. Gd. Indra Partha}

2,b

_{, Wayan Reza Yuda A.P}

3,c

1,3_{Teknik Mesin, Fakultas Teknik, Universitas Udayana, Indonesia}

2_{Teknik Elektro, Fakultas Teknik, Universitas Udayana, Indonesia}

a_{widhiwyn@yahoo.com,}b_{cokindra@ee.unud.ac.id ,}c_{wayan_unnes@yahoo.co.id}

Keywords: Differential-drive robot, Lego Mindstorms NXT, Simulation

Abstract. The aim of this paper is to model and simulate kinematics motion using the differential

drive model of a mobile Lego robot Mindstorm NXT. The author’s use integrated two software as a method to solve the simulation of mobile lego robot mindstorms NXT using Matlab/Simulink and Solidworks software. These softwares are enable easier 3D model creation for both simulation and hardware implementation. A fundamental of this work is the use of Matlab/Simulink Toolboxes to support the simulation and understanding of the various kinematics systems and in particular how the SimMechanics toolbox is used to interface seamlessly with ordinary Simulink block diagrams to enable the mechanical elements and its associated control system elements to be investigated in one common environment. The result of simulation shows the mobile robot movement control based on decentralized point algorithm to follow the precision x and y references that has been specified. The design of the mobile robot is validated in simulation results as proof that this design can achieve the good performance.

Introduction

During the last three decades, the application of robotic has commonly developed in the world of industry and education. Robotics research in the world of education is very rarely done by the students, because the robot modeling and control techniques have a high degree of difficulty. Therefore, the author’s submitted a research paper on " Simulation of a differential-drive wheeled mobile lego robot mindstorms NXT".

The design of the robot is a difficult enough task with some considerations such as the geometry of the robot and the complexity of the mechanism [1]. Traditionally, in need of physical prototypes to test the robot's ability to perform his duties, but it would spend a lot of cost and time. Therefore, to reduce the cost and time, the simulation technique is used as a first step by a designer to model the kinematic and dynamic of mobile robot. Simulation has been known as a powerful tool to support the design, planning and analysis of the dynamic behavior of a robot [2]. Currently, Matlab / Simulink is a very popular software for control engineers, and often implicitly suggest that colleges use this software as a tool to design a controller. The students are familiar with Matlab / Simulink, it obviously would be a significant advantage in program control system. Typically, such real-time interaction between the system and the computer on which Matlab / Simulink has been installed require additional expensive hardware and software [3].

The driver for this research study arose from the limitation of students to understand the robotic course in mechanical engineering of Udayana university. In this paper, the author’s has focused to shows how to easy to model and simulate kinematics motion using the differential drive model in the mobile Lego robot Mindstorm NXT, so it would be expected that students who followed the robot course in a class will be able to make the simulation robot, the robot is able to make a control technique using the Matlab programming language / Simulink.

Applied Mechanics and Materials Vol. 776 (2015) pp 319-324 Submitted: 2015-02-19 © (2015) Trans Tech Publications, Switzerland Accepted: 2015-04-10 doi:10.4028/www.scientific.net/AMM.776.319

(11)

Simulation Technique

Simulation has been identified as a significantstudy tool for robotic systems since the early of the 20th century [4] and now simulation methods area powerful tool supporting the design, planning, analysis, and decisions in different areas of research and development. The Simulink extension to Matlab was identified in 1990 [5], permitting users to establish continuous a causal design graphically without the need of writing code. Now, Simulink has developed in many directions: adding more blocks, built-in algebraic loop solving, and a physical modeling of toolboxes.

Simscape is a toolbox for physical modelling developed by the Mathworks for interfacing with Simulink and it has been available since version R2007A of the Matlab suite [6]. It includes a foundation library, which contains basic components for electrical, hydraulic, mechanical and thermal systems. There are also more specialized toolboxes for physical modelling that now are considered as parts of the Simscape product family. A virtue of this modeling software for mechanical systems is that it provides a single simulation environment for the construction of reliable mechanical and controller models. These models can be reused by converting them into compact, efficient C code for embedded controller implementations [7]. SimMechanics also includes a computer aided design (CAD) to SimMechanics translator that facilities the automatic creation of SimMechanics models from Solidworks software packages.According to Goncalves, the realistic simulation of Lego Mindstorms NXT is presented approach does not replace the training with hardware but an important complement, since it allows to develop robot software without accessing to the real hardware [8].

The author has shown through the demonstration of simulation that it is suitable for the fundamental building of mechanical systems. A fundamental of this work is the use of Matlab/Simulink Toolboxes to support the simulation and understanding of the various dynamics systems and in particular how the SimMechanics toolbox is used to interface seamlessly with ordinary Simulink block diagrams to enable the mechanical elements and its associated control system elements to be investigated in one common environment.

Creating and Modelling Mobile Lego Mindstorms NXT

The design and 3D modelling of a mobile Lego Mindstorms NXT are worked using Solidworks 2013 as CAD software. This software enables easier 3D model creation for both simulation and hardware implementation. Mobile robot has two wheels on left and right with separately driven is called differentially driven mobile robot (DDMR) which is showed in Figure 1.

In general, the determination of a models position, orientation, and visualization of the body use transformation matrices. However, when confronted with a complex model with the multi-degree of freedom mechanism analytic solutions are tedious to determine. The software package Solidworks and Matlab/SimMechanics provides an easier method to analyse physical models.

Fig. 1(a) and 1(b) show the assembly of mobile Lego Mindstorm NXT parts and the complete model respectively. SimMechanics tool provides a reserve to deriving equations and performing them with base blocks. To create a SimMechanics model, the mechanical system should be break down into the building blocks. Ground block place point is at position [0 0 0] in the World CS (coordinate system).

Fig. 1(a). Assembly of mobile Lego Mindstorm NXT parts and 1(b) complete model

(12)

The body of mobile robot is connected to revolute joint. Joint sensor is connected to revolute joint to measure its physical properties such as angular position and angular velocity of the revolute joint. The joint initial condition is used to adjust the initial position of the wheel mobile robot.

Actuator Modelling

The mobile Lego Mindstorms NXT provides two servomotors with built in rotation sensor and a gear ratio. A Lego Mindstorms NXT servomotor is shown in Fig. 2.

Fig. 2 Lego Mindstorms NXT servomotor and DC motor circuit

Speed of motor in robotic is able to change in accessible parameter of source voltage. Motor speed control is required to obtain the various rotation methods and trajectory control. Driving servo dc motor lego robot has two direction, forward and reverse. H-Bridge circuit is required as a methods to determine the position of mobile robot [9].

The following of armature control DC servomotor with the load will be presented using an algorithm. Consider the DC servomotor armature, where in the armature current is constant. In this system transfer function can be written as shown in Fig. 4 as follows:

( )

( ) = [ + + ] = ( + 1) (1)

Trajectory Line

The trajectory planning is necessary to generate the reference inputs to the motion control system, which ensures that the mobile robot executes the planned trajectories.The minimal set of requirement for a mobile robot is to be able to run from an initial position to a final assigned position.

The input of trajectory planning algorithm is the path description, the path constraints, and the constraints imposed by a robot gripper dynamics, whereas the outputs are the joint trajectories in terms of a time sequence of the values attained by position, velocity and acceleration.

Position control is used when the robot finger must be moved with or without load along a prescribed trajectory through the mobile robot workspace. The control system of mobile robot is merely a collection of joint controllers each of which is presented to a single joint to drive it individually. The reference signals for these controllers are supplied by a joint trajectory generator determining the desired joint trajectory from the desired trajectory of the mobile robot.

Kinematics mobile robot

According to Valera, Mobile robot control education provides a motivating subject for the students due to the practical work that it involves and present different activities based on Lego NXT developed for teaching Control Engineering. The tasks that the students must do during this course deal with system identification, dynamic control of the robot’s wheels, kinematic control of the mobile robot, path generation etc [10].

A differential-drive motor robot has two wheel is located in left side and right side. Robot is assumed into 2D domain of XY Cartesian coordinates. In analysis of kinematics robot is assumed drive relatively slowly and wheels are not slippery on the road surface. From the eq. (7) shows the number of degree of freedom in kinematics control is three coordinates which is ( , , ). These

(13)

parameters are needed to control as simultaneously to obtain non-holonomic motion. The average of velocity is shown in the eq. (2) and eq. (3) is the angular velocity of the wheels.

Fig. 3 DDMR in 2D Cartesian coordinates

= +₂ (2)

= − (3)

The parameter of coordinates are provided by eq. (4), and (5) and the position of the mobile robot is calculated by eq. (6).

= (4)

= (5)

= . (6)

Commonly, the equation of differential–drive motor robot is obtained in eq. (7). TNH is

non-holonomic transformation matrices. The variables of , are the radial speed left wheel and right wheel respectively.

= (7)

The mathematic model of a differential drive mobile robot is provided in Fig. 4. It is created in block diagram in Matlab/Simulink. A differential drive mobile robot is controlled in closed loop system. The speed of servomotor is used to drive the wheels and created using constant input references. The body of mobile robot is created in block physical model in Matlab/Simmechanics block.

Fig. 4 Mathematics modeling of Mobile robot with MATLAB/Simulink

Result and Discussion

The physical model of the mobile robot is built using SimMechanics software and the application SimMechanics has also been verified with identical outputs when compared with Simulink simulations. The result for mobile robot simulation is shown in Fig. 5, 6 and 7. Fig. 5

(14)

shows an example of the mobile robot movement control based on decentralized point algorithm. It can be appreciated that mobile robot can follow with precision the x and y references that has been specified. The desired input velocity right wheel and left wheel mobile robot are provided with the different value parameters, 15 rpm and 10 rpm respectively. Therefore the right wheel rotated quickly than left wheel and the mobile robot moved rotation shown in Fig. 6. The mobile robot started a initial position of (0,0) cm, an initial orientation of zero degrees, a final position of mobile robot in coordinates (30000, 6000) cm and a final orientation of zero degrees. The times depicted in the figure is to=0 seconds, t1=200 seconds.

Fig, 5 Animation of Mobile robot in Fig. 6 Result of tracking wheel mobile MATLAB/Simmechanics robot in coordinate x, y

Fig. 7 The simulation results of differential drive mobile robot

Mobile robot is completed with 2 DC servomotors to drive wheels. Fig. 7 shows the simulation results of differential drive mobile robot. The right wheel mobile robot speed rotated from 0 to 3000 rpm and the left wheel mobile robot speed rotated from 0 to 2000 rpm. Therefore mobile robot moved rotation to right direction because the desired speed input in right wheel is bigger than speed in the left wheel and the time simulation is stopped at 200 seconds. The average speed model moved as a linear function and achieved in 2500 rpm at 200 seconds. The maximum angular speed is achieved in 14.5 rpm at 200 seconds.

Conclusion

The application of simulation techniques is presented to support the students in mechanical engineering of Udayana university into design, analysis and control of a differential-drive wheeled mobile robot base on algorithm through integrations both MATLAB and Solidworks. This paper is to model and simulate kinematics motion using the differential drive model of mobile Lego robot Mindstorm NXT. The author’s use integrated two software to solve the simulation of mobile lego robot mindstorms NXT using Matlab/Simulink and Solidworks.

The mobile robot movement has been controlled based on decentralized point algorithm to follow the precision x and y references that has been specified. The design of the mobile robot is validated in simulation results as proof that this design can achieve the good performance. The kinematics control method was extended to control of the trajectory mobile robot.

(15)

Acknowledge

We are deeply and invaluable gratitude a Department of Research and Community Service (LPPM) Udayana University for supporting and finding this Fundamental research Grant though Letter of assignment in the contract of implementation of decentralization research Grant (BOPTN) Fiscal year 2014 No:104.8/UN14.2/PNL.01.03.00/2014

References

[1] Andrew, T Miller “A Versatile Simulator for Grasp Analysis”PhD thesis,Department of Computer Science Columbia University, New York, NY 10027.

[2] Zlajpah, L., Robot Simulation for Control Design. Robot Manipulators Trends and Development.ISBN 978-953-307-073-5, Slovenia

[3] Yoonso, 2011, Control Systems Lab Using a LEGO Mindstorms NXT Motor System, IEEE transactions on education, vol. 54, no. 3, August 2011

[4] Zlajpah, L. “Simulation in robotics” Mathematics and Computers in Simulation, Slovenia, Vol.79, no.4.

[5] Moler, C., The growth of MATLAB and The MathWorks over two decades.The

MathWorks.com: News and Notes, Jan. 2010

[6] Matlab and Simulink. MathWorks, June 1, 2014, Available: http://www.mathworks.com

[7] Ledin, J. M., Dickens and Sharp, J. Single Modelling Environment for Constructing High-Fidelity Plant and Controller Models, American Institute of Astronautics, 2004.

[8] Goncaves, Jos´e Lima, Paulo Malheiros and Paulo Costa, Realistic simulation of a Lego Mindstorms NXT based robot, 18th IEEE International Conference on Control Applications Part of 2009 IEEE Multi-conference on Systems and Control Saint Petersburg, Russia, July 8-10, 2009 [9] John Iovine, Robots, androids, and animatrons, McGraw-Hill, 2001

[10] A. Valera†, M. Vallés†, L. Marín†, A. Soriano†, A. Cervera†, A. Giret‡, Application and evaluation of Lego NXT tool for Mobile Robot Control, 18th IFAC World Congress Milano (Italy) 2011