Multi-Vehicles Formation Control Exploring a Scalar...

24
Multi Multi - - Vehicles Formation Vehicles Formation Control Exploring a Scalar Field Control Exploring a Scalar Field Polytechnic University Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineeri Department of Mechanical, Aerospace, and Manufacturing Engineeri ng ng Polytechnic University ,6 Polytechnic University ,6 Metrotech Metrotech , Brooklyn, NY 11201 , Brooklyn, NY 11201 Mechatronics Mechatronics Professor Professor Vikram Vikram Kapila Kapila Group # 9 Group # 9 Francesca Francesca Fiorilli Fiorilli <[email protected]> <[email protected]> Saran Saran Kakarlapudi Kakarlapudi < < [email protected] [email protected] > > Danny Tan Danny Tan <[email protected]> <[email protected]>

Transcript of Multi-Vehicles Formation Control Exploring a Scalar...

Page 1: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

MultiMulti--Vehicles Formation Vehicles Formation Control Exploring a Scalar FieldControl Exploring a Scalar Field

Polytechnic UniversityPolytechnic UniversityDepartment of Mechanical, Aerospace, and Manufacturing EngineeriDepartment of Mechanical, Aerospace, and Manufacturing Engineeringng

Polytechnic University ,6 Polytechnic University ,6 MetrotechMetrotech, Brooklyn, NY 11201, Brooklyn, NY 11201

MechatronicsMechatronicsProfessor Professor VikramVikram KapilaKapila

Group # 9 Group # 9 Francesca Francesca FiorilliFiorilli <[email protected]><[email protected]>

Saran Saran KakarlapudiKakarlapudi <<[email protected]@gmail.com>>

Danny Tan Danny Tan <[email protected]><[email protected]>

Page 2: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

OverviewOverviewObjectiveObjectiveSpecificationsSpecificationsFunctionality and AlgorithmFunctionality and AlgorithmHardwareHardwareCircuit DiagramCircuit DiagramPhotos of ProductPhotos of ProductPBasicPBasic CodeCodePrototype Cost AnalysisPrototype Cost AnalysisProduct LimitationsProduct LimitationsConclusion and ImprovementsConclusion and ImprovementsAcknowledgementsAcknowledgements

Page 3: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

ObjectiveObjective

Exploring a Scalar Field using Multiple Exploring a Scalar Field using Multiple ––Mobile Agents both In and Out of Mobile Agents both In and Out of FormationFormation

Light Light 3 Mobile Agents3 Mobile AgentsEquilateral Triangle FormationEquilateral Triangle Formation

Page 4: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

Specifications (aimed at)Specifications (aimed at)Controlled by Basic Stamp 2 microcontroller (succeeded)Controlled by Basic Stamp 2 microcontroller (succeeded)Safety featuresSafety features

Instantaneous shutdown safety switch (did not use)Instantaneous shutdown safety switch (did not use)Hard/Software features to prevent damage to the BS2 and other Hard/Software features to prevent damage to the BS2 and other components (partially used)components (partially used)

User Interface/Control (partially used)User Interface/Control (partially used)On/Off RF controller On/Off RF controller

Analog Sensor (succeeded)Analog Sensor (succeeded)Photo Photo -- resistorresistor

Digital Sensor (succeeded)Digital Sensor (succeeded)RF transceiverRF transceiver

Actuators (succeeded)Actuators (succeeded)Full rotation servo motors (6)Full rotation servo motors (6)

Page 5: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

MultiMulti--Vehicle Formation ControlVehicle Formation Control

System of controls for multiSystem of controls for multi--vehicles vehicles driven in formationdriven in formationEach capable of exploring a scalar fieldEach capable of exploring a scalar field

Light Intensity field (our choice)Light Intensity field (our choice)Basic Stamp powered computingBasic Stamp powered computingUse RF transceivers to communicateUse RF transceivers to communicateBattery powered systemBattery powered system

9V batteries9V batteries

Page 6: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

Functionality and AlgorithmFunctionality and Algorithm

CASE 1: Stand Alone OperationCASE 1: Stand Alone OperationMaster is Manually DrivenMaster is Manually DrivenFollowers Receive command from MasterFollowers Receive command from MasterMaintenance of FormationMaintenance of FormationTriggering Signal for Breaking of FormationTriggering Signal for Breaking of FormationVehicle stops at a Safe Distance from Light Vehicle stops at a Safe Distance from Light SourceSourceIf Job finished, then it communicates with the If Job finished, then it communicates with the other vehicles and if necessary repeats the other vehicles and if necessary repeats the above algorithmabove algorithm

Page 7: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

Functionality and Algorithm 2Functionality and Algorithm 2

CASE 2: Formation OperationCASE 2: Formation OperationWhen Triggered, Master senses the Scalar When Triggered, Master senses the Scalar Field (Light Intensity) and comes up with the Field (Light Intensity) and comes up with the TrajectoryTrajectoryMaster Guides the Followers through RF Master Guides the Followers through RF transceiverstransceiversStoppage at Safe Distance from Light SourceStoppage at Safe Distance from Light SourceOnce Job is finished, the above algorithm is Once Job is finished, the above algorithm is repeatedrepeated

Page 8: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

HardwareHardware

BoeBoe--BotBot Robot KitRobot KitBasic Stamp 2 (1)Basic Stamp 2 (1)Board of Education (1)Board of Education (1)Robot chassis (1)Robot chassis (1)Servos (2)Servos (2)Resistors (2 , 1, 1)Resistors (2 , 1, 1)

Page 9: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

Hardware 2Hardware 2

912MHz RF transceiver (1)912MHz RF transceiver (1)800 ft range 800 ft range 9600 baud serial9600 baud serial1616--bit CRC Error Checking bit CRC Error Checking FIFO Buffer FIFO Buffer +3V to +5V Operation +3V to +5V Operation BuiltBuilt--In Antenna In Antenna

PhotoresistorPhotoresistor (1)(1)

Page 10: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

Hardware 3Hardware 3IR Sensor IR Sensor (Used only on (Used only on the Master)the Master)

IR RemoteIR Remote

* figures are not to * figures are not to

Page 11: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

Circuit DiagramCircuit DiagramThe Picture beside The Picture beside is a Simple Circuit is a Simple Circuit Diagram for the Diagram for the Usage of RC time Usage of RC time command.command.

This is Used This is Used indirectly to obtain indirectly to obtain determine the determine the Relative Intensity of Relative Intensity of LightLight

Page 12: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

Circuit Diagram 2Circuit Diagram 2Circuit for the IR Circuit for the IR ReceiverReceiver

Reading at PIN 9 Reading at PIN 9 depends on the key depends on the key which is pressed on which is pressed on the IR Remote (our the IR Remote (our TV remote)TV remote)

Page 13: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

IR WavesIR Waves

Page 14: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

RF TransceiverRF Transceiver

Page 15: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

Photos of ProductPhotos of Product

Page 16: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

Photos of the Product 2Photos of the Product 2

Page 17: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

PBasicPBasic CodeCode

Page 18: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

Prototype Cost AnalysisPrototype Cost Analysis

Parts Name Unit Cost Quantity Sum Total Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95 3 $ 479.85

912MHz RF Transceivers $ 49.95 3 $ 149.85

3 Function Universal Remote $ 10.00 1 $ 10.00

Miscellaneous (shipping, taxes, etc.) $ 100.00

Total Prototype Cost: $ 739.70

Prototype Unit Cost = $209.90Prototype Unit Cost = $209.90Mass Production Unit Cost = $146.25 Mass Production Unit Cost = $146.25 ---- $120.22$120.22

Page 19: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

ApplicationsApplications

Semi Semi –– Autonomous Fire Fighting SystemAutonomous Fire Fighting SystemSemi Semi –– Autonomous Radiation and/or Gas Autonomous Radiation and/or Gas leak detection systemleak detection systemRemote mapping of any Scalar FieldRemote mapping of any Scalar Field

Page 20: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

Product LimitationsProduct LimitationsOpen Open –– Loop ControlLoop Control

Velocity of the vehicles is not monitored, trouble with Velocity of the vehicles is not monitored, trouble with variable terrainvariable terrainNo distance measurement between the vehicles, No distance measurement between the vehicles, chance of formation degradationchance of formation degradationOnce disturbed, the initial formation cannot be Once disturbed, the initial formation cannot be reformedreformed

Unable to Avoid ObstacleUnable to Avoid ObstacleLack of obstacle avoidance algorithmLack of obstacle avoidance algorithm

•• Greatly increase complexity to avoid obstacles and keep Greatly increase complexity to avoid obstacles and keep formation formation

Page 21: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

Conclusion and ImprovementsConclusion and Improvements

ConclusionsConclusionsCoarsely StableCoarsely StableSystem is DelicateSystem is DelicateSensitive to TerrainSensitive to Terrain

Page 22: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

Conclusion and ImprovementsConclusion and Improvements

ImprovementsImprovementsClosed Closed –– Loop System for Velocity and Loop System for Velocity and Distance Distance Active search to relocate and reform in group Active search to relocate and reform in group formation formation Add other sensors to increase application useAdd other sensors to increase application useMultiple formation selectionsMultiple formation selections

Page 23: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

AcknowledgementsAcknowledgements

Mechatronics Lab: For lending extra Mechatronics Lab: For lending extra BoeBoe --Bots for useBots for useGroups that helped with tools and Groups that helped with tools and materialsmaterials

Group 3: VitoGroup 3: Vito GuardiGuardi & Joseph Ferrari & Joseph Ferrari •• Providing extra Basic Stamps 2 Providing extra Basic Stamps 2

Graphics: Parallax Incorporated Graphics: Parallax Incorporated ((http://http://www.parallax.comwww.parallax.com//))

Page 24: Multi-Vehicles Formation Control Exploring a Scalar Fieldengineering.nyu.edu/mechatronics/projects/ME3484... · Boe-Bot Robot Kit (Servos, Microcontroller, sensors included) $ 159.95

Questions?Questions?