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

Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

Embed Size (px)

Citation preview

Page 1: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

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

Polytechnic UniversityPolytechnic UniversityDepartment of Mechanical, Aerospace, and Manufacturing EngineeringDepartment of Mechanical, Aerospace, and Manufacturing Engineering

Polytechnic University ,6 Metrotech, Brooklyn, NY 11201Polytechnic University ,6 Metrotech, Brooklyn, NY 11201

MechatronicsMechatronicsProfessor Vikram KapilaProfessor Vikram Kapila

Group # 9 Group # 9

Francesca Fiorilli Francesca Fiorilli <[email protected]><[email protected]>

Saran Kakarlapudi Saran Kakarlapudi <[email protected]><[email protected]>

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

Page 2: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

OverviewOverview ObjectiveObjective SpecificationsSpecifications Functionality and AlgorithmFunctionality and Algorithm HardwareHardware Circuit DiagramCircuit Diagram Photos of ProductPhotos of Product PBasic CodePBasic Code Prototype Cost AnalysisPrototype Cost Analysis Product LimitationsProduct Limitations Conclusion and ImprovementsConclusion and Improvements AcknowledgementsAcknowledgements

Page 3: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

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 Agents Equilateral Triangle FormationEquilateral Triangle Formation

Page 4: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

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 - resistorPhoto - resistor 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 Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

Multi-Vehicle Formation ControlMulti-Vehicle Formation Control

System of controls for multi-vehicles System of controls for multi-vehicles driven in formationdriven in formation

Each 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 computing Use RF transceivers to communicateUse RF transceivers to communicate Battery powered systemBattery powered system

9V batteries9V batteries

Page 6: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

Functionality and AlgorithmFunctionality and Algorithm

CASE 1: Stand Alone OperationCASE 1: Stand Alone Operation Master is Manually DrivenMaster is Manually Driven Followers Receive command from MasterFollowers Receive command from Master Maintenance of FormationMaintenance of Formation Triggering Signal for Breaking of FormationTriggering Signal for Breaking of Formation Vehicle stops at a Safe Distance from Light Vehicle stops at a Safe Distance from Light

SourceSource If Job finished, then it communicates with the If Job finished, then it communicates with the

other vehicles and if necessary repeats the above other vehicles and if necessary repeats the above algorithmalgorithm

Page 7: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

Functionality and Algorithm 2Functionality and Algorithm 2

CASE 2: Formation OperationCASE 2: Formation Operation When 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 TrajectoryTrajectory

Master Guides the Followers through RF Master Guides the Followers through RF transceiverstransceivers

Stoppage at Safe Distance from Light SourceStoppage at Safe Distance from Light Source Once 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 Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

HardwareHardware

Boe-Bot Robot KitBoe-Bot Robot Kit Basic 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, Resistors (2 , 1,

1)1)

Page 9: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

Hardware 2Hardware 2

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

Photo Resistor (1)Photo Resistor (1)

Page 10: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

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

IR RemoteIR Remote

* figures are not to Scale* figures are not to Scale

Page 11: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

Circuit DiagramCircuit Diagram

The 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 Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

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 Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

IR WavesIR Waves

Page 14: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

RF TransceiverRF Transceiver

Page 15: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

Photos of ProductPhotos of Product

Page 16: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

Photos of the Product 2Photos of the Product 2

Page 17: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

PBasic CodePBasic Code

Page 18: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

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.90 Mass Production Unit Cost = $146.25 -- $120.22Mass Production Unit Cost = $146.25 -- $120.22

Page 19: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

ApplicationsApplications

Semi – Autonomous Fire Fighting SystemSemi – Autonomous Fire Fighting System Semi – Autonomous Radiation and/or Gas Semi – Autonomous Radiation and/or Gas

leak detection systemleak detection system Remote mapping of any Scalar FieldRemote mapping of any Scalar Field

Page 20: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

Product LimitationsProduct Limitations Open – Loop ControlOpen – Loop Control

Since the Velocity of the Vehicles is not monitored, we Since the Velocity of the Vehicles is not monitored, we will have trouble if the terrain varies by a lot.will have trouble if the terrain varies by a lot.

Since there is no distance measurement between the Since there is no distance measurement between the vehicles, there is a chance that they may loose vehicles, there is a chance that they may loose formation.formation.

Once disturbed, the initial formation cannot be obtainedOnce disturbed, the initial formation cannot be obtained

Unable to Avoid ObstacleUnable to Avoid Obstacle Does not include Obstacle avoidance algorithm as it Does not include Obstacle avoidance algorithm as it

would become very much complicated to avoid would become very much complicated to avoid obstacles and maintain formation.obstacles and maintain formation.

Page 21: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

Conclusion and ImprovementsConclusion and Improvements

ConclusionsConclusions Coarsely StableCoarsely Stable System is DelicateSystem is Delicate Sensitive to TerrainSensitive to Terrain

Page 22: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

Conclusion and ImprovementsConclusion and Improvements

ImprovementsImprovements Closed – Loop System for Velocity and Closed – 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 use Multiple formation selectionsMultiple formation selections

Page 23: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

AcknowledgementsAcknowledgements

Mechatronics Lab: For lending extra Boe - Mechatronics Lab: For lending extra Boe - Bots for useBots for use

Groups that helped with tools and Groups that helped with tools and materialsmaterials Vito Guardi & Joseph Ferrari Vito Guardi & Joseph Ferrari

• Providing extra Basic Stamps 2 Providing extra Basic Stamps 2

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

Page 24: Multi-Vehicles Formation Control Exploring a Scalar Field Polytechnic University Department of Mechanical, Aerospace, and Manufacturing Engineering Polytechnic

Questions?Questions?