Sunteți pe pagina 1din 5

2015 International Conference on Industrial Instrumentation and Control (ICIC)

College of Engineering Pune, India. May 28-30, 2015

Multi Robot Communication And Target Tracking


System With Controller Design And Implementation
Of SWARM Robot Using Arduino

Dhiraj Arun Patil, Manish Y. Upadhye, F. S. Kazi, N. M. Singh


Department of Electrical Engineering
Veermata Jijabai Technological Institute
Mumbai 400 019, INDIA
Email: pdhiraj4@gmail.com

Abstract—SWARM robotics or multi robot systems is a novel adaptability, fault-tolerance, scalability, and so on. Application
approach to the coordination of large numbers of relatively areas of multi robot system are environmental monitoring,
simple robots which takes its inspiration from social insects - surveillance, distributed sensing task, oil cleaning, underwater
ants, termites, wasps and bees etc. Local communication can localization and many more.
be achieved by different types of wireless transmission systems. Role of sensing system is to detect the presence of objects
Different types of sensing system, Communication system and
design approaches are used in SWARM robotics. This paper
and measure their positions. The objects can be neighbouring
presents a controller design and hardware specifications of robot robots, obstacles and target. Technical challenge is to develop
for SWARM application using Arduino MEGA-2560 which is and deploy real mobile robots at a reasonable cost [1],[6]. If
having Atmel’s ATmega2560 microcontroller. Implementation data obtained from location sensing system is based on fixed
details are explained, and application of the multi-agent system global reference then it is absolute sensing and if it is based on
is verified through algorithms. Multi Robot Communication is local coordinates of a robot then it is relative sensing. Global
implemented to achieve Leader-Follower approach of SWARM positioning system (GPS) with central monitoring system is an
navigation where leader robot guides the slave robots. Target example of absolute location sensing [7]. Examples of relative
Tracking or Move to Goal algorithm is implemented on robot location sensing include proximity sensors [8], cameras [9]
which allows one robot to reach target directed by other and received signal strength indicator (RSSI) [10]. A SWARM-
robot. Communication between robots is achieved using low cost
CC2500 wireless transceiver module which is designed for very
BOT is comprised of autonomous mobile robots called S-Bots.
low-power wireless applications. Authors in [4] discuss the self-assembling capabilities of the
SWARM-BOT, this concept lies at the intersection between
Keywords—SWARM Robotics, Multi Robot Communication, collective and self-reconfigurable robotics.
Target Tracking, Arduino. For interaction of the multiple robots, communication
between robots is important to carry out specific task where
I. I NTRODUCTION one robot delivers orders or updates to other robots [11],[12].
With advance in wireless communication technology it is
SWARM robotics is a concept to provide a robust robotics possible to interface one device to other device. Advantage
system using large numbers of identical robots inspired from of communication between the robots is completing the task
social behaviour of animals or insects. Collective behaviour of in efficient way [13]. Wireless Local Area Network (WLAN)
robots comes from the interactions between individual robots which is based on IEEE 802.11 standards and WPAN uses
and interactions of robots with the environment [1]. With some technologies such as Infrared, Wireless USB, Bluetooth,
this approach it is easily possible to complete the tasks that and ZigBee for communication between sensors and electronic
are difficult to do with single robot. Research is going on devices [14]. Inductive Communication is one of the methods
in the area of sensor technology, motor technology, power of communication for Millimeter-sized Wireless Robots [15].
supply technology, telecommunications technology, control In this paper we present the design and implementation
technology and artificial intelligence technology for robotics. of S-Bot robot for SWARM application using Arduino micro-
In SWARM robotics, cooperative task solving capability refers controller. In first algorithm, Multi Robot Communication is
to self-organization and emergence. Self-organization refers implemented to achieve Leader-Follower approach of SWARM
to the SWARM’s organization which comes from system navigation in which one robot follows other robot. Concept
itself and emergence means that the organization need to of co-operative navigation using master-slave SWARM robot
have local interaction between individual robots comes about is introduced. To achieve Target Tracking system, another
decentralized way [2]. For controlling motions of individual algorithm is implemented on the S-Bot robot which allows
robot different coordination approaches have been reported one robot to track a location directed by other robot. Sender
such as task allocation [3], self-configuration [4], pattern gen- robot gives target coordinates along with final angle position
eration [5]. Instead of investigation of a single robot system, to receiver robot. After successfully calculating path trajectory
researchers are working for exploration of coordination of receiver robot reaches to its goal configuration.
multi-robot/SWARM systems as there are several advantages The rest of this paper is organized as follows. Section II
and application of multi-robot systems. These are; efficiency, gives a description of the hardware specifications of S-Bot

978-1-4799-7165-7/15/$31.00 ©2015 IEEE 412


robot. Section III presents algorithms implemented on robots
and Section IV illustrates experimental results. Finally, Section
V explains conclusions and future work.

II. T HE H ARDWARE D ESIGN


The hardware assembly and specifications of S-Bot robot
is explained in this section. Fig 1 shows the S-Bot robot and
its different modules. Fig 2 shows basic architecture block
diagram of the S-Bot robot. The robot uses Arduino MEGA-
2560 board as central processor and other input and output
devices along with communication module and power supply.

Fig. 3. Hardware contains of S-Bot (a) Arduino Micro-controller MEGA


2560 (b) CC2500 Communication Module (c) Ultrasonic Distance sensor -
HC-SR04 (d) Sharp Distance sensor 2Y0A21 (e) IR Proximity sensor

B. Motion
S-Bot robot has two DC geared motors for motion control.
One caster wheel is attached to front end of robot for support.
Driving system of robot allows it to move forward, backward
and rotate clockwise or anticlockwise. Along with DC motor
S-Bot has servo motors for the movement of sensors. Distance
sensors are attached to the rotary part of servo motors hence
Fig. 1. S-Bot Mobile Robot
direction of sensors or sensory area can be changed using servo
mechanism.

C. Sensory System
S-Bot robot has various sensors used for different applica-
tion. Fig 3 (c) and (d) shows ultrasonic distance sensor HC-
SR04 and sharp distance sensor 2Y0A21 respectively. Working
range of Ultrasonic ranging module HC - SR04 is 2cm to
400cm with accuracy of 3mm. Sharp GP2Y0A21YK0F is a
distance measuring sensor with Distance measuring range from
10 to 80 cm. Output voltage from sensor is corresponding to
the detection distance from sensor to an object. Fig 3 (e) shows
general purpose proximity sensor using IR emitter and IR re-
ceiver pair. It is very compact and has low power consumption.
The range varies between 2cm to 15cm depending on ambient
light. Using on-board potentiometer range can be calibrated.
Fig. 2. Block Diagram

D. Communication
In multi robot system for inter robot communication media
A. Controller is used to share information and make a collective decision.
S-Bot robot has Arduino MEGA-2560 development board We have used CC2500 Serial Communication Module for
which consists of Atmel’s ATmega2560 microcontroller with communication as shows in Fig 3 (b). The CC2500 is a low-
other electronic components which can be programmed using cost 2.4 GHz transceiver which is designed for very low-power
the software. It has 256 KB of flash memory, 54 input and wireless applications. The module is designed to work for the
output pins including 16 - Analog pins and 14 PWM pins. 2400-2483.5 MHz ISM (Industrial, Scientific and Medical)
Board can be connected to DC power supply up to 12V or it and SRD (Short Range Device) frequency band. CC2500 has
can be powered directly using a USB port without any external RS232 UART interface with variable baud rate, Programmable
power. Internal voltage regulator regulates it to 5V and 3.3V. Device Address (255 per channel) and Standard configuration
Arduino is an excellent open source platform. Arduino boards baud rate of 9600. CC2500 works up to range 30-50 meters
can be programmed using the Arduino Programming Language for line of sight. We used this module as it works satisfactory
(APL) [16]. Fig 3 (a) shows Arduino micro-controller board. up to 10 meters for indoor environment.

413
E. Power management
In SWARM application every mobile robot must have a
sufficient battery power to complete a given task. This S-Bot
has 12 Volts rechargeable battery for powering of all system.
Using external charger battery can be charged as and when
required.
III. A LGORITHM
In this paper two algorithms are performed on S-Bot
robot. One algorithm is to test Multi Robot Communication
or Leader-Follower approach which can be implemented on
two or more S-Bot robots. Another algorithm is to test Target
Tracking system or Move to Goal approach.
A. Multi Robot Communication or Leader-Follower Approach
Fig 4 shows experimental setup for Multi Robot Commu-
nication or Leader-Follower approach. There is one leader and
there can be one or more follower robots. The leader robot
consists of an Arduino board as the centre controller of all
the systems. Motion system consists of a DC motor driven
with Driver. A communication system has CC2500 wireless
communication Module. This Module work as communication
between leader robot and follower robots. Follower robot
just follows the movements of the leader robot by receiving
commands via wireless modules. Fig. 6. Flow chart : Follower S-Bot Robot

Fig 5 and fig 6 shows flowchart of Leader S-Bot robot


and Follower S-Bot robot respectively. Task of leader robot
is to continuously broadcast a character serially related to
its motion. We have used four motions Forward, Backward,
rotate right (clockwise) and rotate left (anticlockwise). Special
character value has been assigned to each motion. This value
is used to send serially for particular motion continuously
with standard baud rate. While a receiver robot continuously
receives a character value and depending on its value motions
are performed. For successful communication baud rate at
leader robot and all the follower robots should be same. Also
channel used for all CC2500 maintained same.
Fig. 4. Multi Robot Communication : Setup
B. Target Tracking System or Move to Goal Approach
Fig 7 shows experimental setup for Target Tracking system
using S-Bot robot to observe Move to Goal approach. Initial
coordinates of the S-Bot robot are assumed to be (x0 , y0 ) =
(0, 0) and initial angle θ0 is also 0 degree. This S-Bot acts
as a receiver robot as it continuously receives target location
given by another sender S-Bot. Coordinates of Goal/ Target
(x1 , y1 ) and final angle θ1 are given from serial monitor on
PC connected to sender S-Bot robot using USB cable. Sender
S-Bot serially receives coordinates value and broadcasts it
on another serial channel. Calculation and other debugging
parameters can be observed on PC serial monitor.
Fig 8 shows path followed by receiver S-Bot robot to reach
to desired location. Distance to travel “r” and initial angle
of rotation “α” both are calculated using target coordinates
(x1 , y1 ). Final angle of position is directly taken as value of
θ1 . Now all this values of α, r and θ1 are used to move receiver
S-Bot to desired target location. Movement of operations are
as follows: First S-Bot takes Left or Right turn depending on
value of α, and then S-Bot moves Forward depending on value
Fig. 5. Flow chart : Leader S-Bot Robot of r and finally S-Bot takes Left or Right turn depending on
value of both θ1 and α.

414
follower robot not having any movements but as soon as leader
robot moves as per predefined path then follower robot follows
the movements of leader robot. Sequence of operations is as
follows: (a) At start, Leader S-Bot and Follower S-Bot both
robots are kept off. (b) Follower S-Bot robot turns on but
it remains stand still. (c) Leader S-Bot turns on. (d) Both
robots move forward. (e) Both robots turn right. (f) Both robots
move forward. (g) Both robots turn left. (h) Both robots move
backward.

Fig. 7. Target Tracking System : Setup


r= x21 + y12 (1)
 
y1
α = tan−1 (2)
x1

Fig. 8. Target Tracking System : Path Planning


Fig. 9. Experimental Result for Leader-Follower Approach

IV. E XPERIMENTAL VALIDATION AND R ESULTS


This section presents the experimental results of the above
algorithms which are implemented on S-Bot. All the experi- B. Target Tracking System or Move to Goal Approach
ments were performed indoor on plane surface. The objective Fig 11 shows experimental result for Target Tracking or
of these experiments was to test the algorithms on designed Move to Goal approach performed on S-Bot robots. Sender S-
S-Bot robots. Bot robot were connected to PC and given (x1 , y1 ) coordinates
along with final angle θ1 . All values were given as input
A. Multi Robot Communication or Leader-Follower Approach parameters through serial monitor as x, y and z integer values
Fig 9 shows experimental result for Multi Robot Commu- as shown in fig 10. Fig 11 (a) to (f) shows snapshots of
nication or Leader-Follower approach with S-Bot. Fig 9 (a) to movements with the receiver S-Bot robot. As we were entered
(h) shows the snapshots of the Leader-Follower process. We same value of x and y, S-Bot follows left turn for angle of 45
have performed experiment with two S-Bot with one Leader degree (fig 11-c). Then it moves upto distance r unit (fig 11-d
and one follower. In top view Leader and Follower S-Bot robot and e). Finally it additionally turns left to achieve final angle
can be seen at right and left position respectively. Initially position of 180 degree (fig 11-f).

415
include use of other sensors (ultrasonic, sharp distance, IR
proximity) which are implemented on S-Bot robot. Those
sensors would be useful to avoid collision between multiple
robots. Further algorithm would include Simultaneous local-
ization and mapping (SLAM) and pattern formation.
ACKNOWLEDGMENT
The authors would like to acknowledge the support of
Center of Excellence in Complex and Non-Linear Dynamical
Systems (CoE-CNDS), VJTI, Mumbai, India for providing
research facilities.
R EFERENCES
[1] E. Sahin, “Swarm robotics: From sources of inspiration to domains of
application,” in Proc. 8th Int. Conf. Simulation of Adaptive Behavior
(LNCS), 2005, vol. 3342, pp. 10-20.
[2] Frederick Ducatelle, Gianni A. Di Caro, Carlo Pinciroli, Francesco
Mondada and Luca Gambardella, “Communication assisted navigation
in robotic swarms: self-organization and cooperation,” IEEE/RSJ Inter-
national Conference on Intelligent Robots and Systems, San Francisco,
CA, USA, September 25-30, 2011.
Fig. 10. Serial Monitor : Sender S-Bot [3] Aleksandar Jevti c, Alvaro Gutierrez, Diego Andina, and Mo Jamshidi,
“Distributed bees algorithm for task allocation in swarm of robots,” IEEE
IEEE Systems Journal, Vol. 6, No. 2, June 2012.
[4] RoderichGro, Michael Bonani, Francesco Mondada, and Marco Dorigo,
“Autonomous self-assembly in swarm-bots,” IEEE Trans. On Robotics,
Vol. 22, No. 6, December 2006.
[5] Jun Zeng, DaoyongLiu, Alei Liang, Haibing Guan, “Pattern formation
using multiple robots,” IEEE 6th International Conference, 2009 , Pp.
1074-1076.
[6] Geunho Lee and Nak Young Chong, “Low-cost dual rotating infrared
sensor for mobile robot swarm applications,” IEEE Trans. On Industrial
Informatics, Vol. 7, No. 2, May 2011.
[7] S. Panzieri, F. Pascucci, and G. Ulivi, “An outdoor navigation systemus-
ing GPS and inertial platform,” IEEE/ASME Trans. Mechatronics, vol.
7, no. 2, pp. 134-142, Jun 2002.
[8] J. F. Roberts, T. S. Stirling, J.-C.Zufferey, and D. Floreano, “2.5D infrared
range and bearing system for collective robotics,” in Proc.IEEE/RSJ Int.
Conf. Intell.Robot. Syst., 2009, pp. 3659-3664.
[9] N. Moshtagh, N. Michael, A. Jadbabaie, and K. Daniilidis, “Vision
based, distributed control laws for motion coordination of nonholonomic
robots,” IEEE Trans. Robotics, Vol. 25, No. 4, Pp. 851-860, Aug.2009.
[10] S. Park and S. Hashimoto, “Autonomous mobile robot navigation using
passive RFID in indoor environment,” IEEE Trans. Ind. Electron, Vol.
56, No. 7, Pp. 2366-2373, Jul. 2009.
[11] Emaad Mohamed H. Zahugi, Ahmed M. Shabani and Dr. T. V. Prasad,
“Libot: design of a low cost mobile robot for outdoor swarm robotics,”
IEEE International Conference on Cyber Technology in Automation,
Control and Intelligent Systems, May 27-31, 2012.
[12] Saxena Ankita, Satsangi C.S., Saxena Abhinav, “Collective collabora-
tion for optimal path formation and goal hunting through swarm robot,”
IEEE 5th International Conference on Confluence The Next Generation
Information Technology Summit, 2014 , Pp. 309-312.
Fig. 11. Experimental Result for Move to Goal Approach [13] Andi Adriansyah, “Xbee implementation on mini multi-robot system,”
The Proceedings of The 7th ICTS, Bali, May 15th-16th, 2013.
[14] Labiod, H, Afifi, H. And De Santis, C, “WiFiTM, BluetoothTM,
ZigBeeTM, AndWimaxTM,” Springer, Netherlands, (2007).
V. C ONCLUSION AND FUTURE WORK
[15] Sohee Kim, Thorsten Knoll, and Oliver Scholz, “Feasibility of inductive
We presented controller design of simple S-Bot robot using communication between millimeter-sized wireless robots” IEEE Trans.
Arduino MEGA 2560 controller board and other sensors and On Robotics, Vol. 23, No. 3, June 2007.
actuators. Experiments were performed on S-Bot to be used [16] Available at: http://www.arduino.cc.
in SWARM robotics applications. Leader-Follower approach
algorithm for Multi Robot Communication and Move to Goal
or Target Tracking algorithm were successfully implemented
on S-Bot. Multi Robot Communication is observed from
Leader-Follower experiment. In Move to Goal approach one
robot guides other robot to reach particular location and angle.
Both experiments show expected results. Future work would

416

S-ar putea să vă placă și