how to make multi-robots formation control system

36
11/12/01 A Hobby Robotics Recipe Keisuke UTO @utotch How To Make Multi-Robot Formation Control System

Upload: keisuke-uto

Post on 27-May-2015

6.818 views

Category:

Self Improvement


5 download

DESCRIPTION

I made multi-robot formation control system. You can control robot by inputting stroke on iPad. I explain how to make the system.

TRANSCRIPT

Page 1: How To Make Multi-Robots Formation Control System

11/12/01

A Hobby Robotics Recipe

Keisuke UTO @utotch

How To Make Multi-Robot Formation Control System

Page 2: How To Make Multi-Robots Formation Control System

Motivation

11/12/01

•  Denso.Inc Company Group(Car Equipment Company In Japan) holds a idea contest “Muran”(means Eggs of dreams) every other year

•  Employee can submit ideas which they want to be come true and if the ideas are adopted, they can get some money to make them.

•  I subscribed a idea of next page

Page 3: How To Make Multi-Robots Formation Control System

11/12/01

You can line up Radio Controlled Cars by only drawing a curve!

Line up to a ‘S’ shape

We finished line up!

Roger!!

Robots line up to be a shape of you input

Multi-Robot Formation Control by stroke input

If you input a stroke,

Page 4: How To Make Multi-Robots Formation Control System

11/12/01

How do I realize this idea?? I thought a implementation of next page.

Page 5: How To Make Multi-Robots Formation Control System

11/12/01

Rough Design of a implementation

WiFi

ZigBee

USB Camera

iPad

Swarm Robots

Page 6: How To Make Multi-Robots Formation Control System

11/12/01

But, a budget of making this system was limited. Can I make this system by a limited budget ?? It’s difficult to make robots which can move free directions. (It’s difficult to move free directions by normal 4 wheels cars) I surveyed that how to make this system by using market products.

Page 7: How To Make Multi-Robots Formation Control System

11/12/01

Ideas of moving free directions system

Mechanum wheel

Airtrex Omni Directional Drive Honda U3-X

NISSAN Pivo2 Omni-Wheel

Page 8: How To Make Multi-Robots Formation Control System

11/12/01

Can I get moving free directions system in market product??

WowWee.Inc ROVIO ($350)

http://www.wowwee.com/en/products/tech/telepresence/rovio/rovio

Which has a camera, and can be controlled by WiFi It’s too expensive if I buy it a lot.

Page 9: How To Make Multi-Robots Formation Control System

11/12/01

Since a budget is limited, I gave up to make my system using market products. Then I decided to make them by myself. I didn’t predict many hard troubles of making robot by myself…

Page 10: How To Make Multi-Robots Formation Control System

11/12/01

Hardware design of meeting my budget

http://www.tosadenshi.co.jp/blog/18cm.html

18cm Omni-Wheel Kit Reasonable Version 14,500JPY

Tosa Electric.Inc(in Japan)

4 Wheel urethane omni-wheel kit 53,000JPY

Appendix

I adapted this system which is most reasonable.

Page 11: How To Make Multi-Robots Formation Control System

11/12/01

Robot Implementation LEGO Blocks

XBee Wireless Module

Page 12: How To Make Multi-Robots Formation Control System

11/12/01

Robot Implementation(detail)

Motor IC x 4 (Toshiba TA7291P)

Micro Computer (Arduino FIO)

Omni-Wheel

Page 13: How To Make Multi-Robots Formation Control System

11/12/01

I introduce some parts and technologies of making my system

Page 14: How To Make Multi-Robots Formation Control System

11/12/01

Arduino FIO

・2500 JPY ・Xbee can be attached directly ・Analogue Input (x8) ・Digital I/O (x14) ・Enable PWM Output (x6)

Summary

Microcontroller ATmega328P Operating Voltage 3.3V Input Voltage 3.35 -12 V Input Voltage for Charge 3.7 - 7 V Digital I/O Pins 14 (of which 6 provide PWM output) Analog Input Pins 8 DC Current per I/O Pin 40 mA Flash Memory 32 KB (of which 2 KB used by bootloader) SRAM 2 KB EEPROM 1 KB Clock Speed 8 MHz

Page 15: How To Make Multi-Robots Formation Control System

11/12/01

ZigBee

http://www.switch-science.com/products/detail.php?product_id=96

One of specs of wireless communication in short distance

In Japan, 2.4GHz (250Kbps) band can be used.

Xbee Wireless Module(2500JPY) We can use Xbee as a pseudo serial port

Point-to-Point

Point-to-Multi-Point

Page 16: How To Make Multi-Robots Formation Control System

11/12/01

How To Make Swarm Robots (by myself)

Page 17: How To Make Multi-Robots Formation Control System

11/12/01

How to make Robots

A My Colleague said> You should make printed circuit boards I said> I don’t have skills of doing that.

Page 18: How To Make Multi-Robots Formation Control System

11/12/01

Make!

Page 19: How To Make Multi-Robots Formation Control System

11/12/01

And still more Make!

Page 20: How To Make Multi-Robots Formation Control System

11/12/01

And still more more Make!!

Page 21: How To Make Multi-Robots Formation Control System

11/12/01

Done!!

Page 22: How To Make Multi-Robots Formation Control System

11/12/01

Overview of my system

Page 23: How To Make Multi-Robots Formation Control System

11/12/01

How do I implement computer vision system?? I implement them totally by myself .

Page 24: How To Make Multi-Robots Formation Control System

11/12/01

But…, There were many difficult problem to detect multiple 2D markers which were placed a far distance from a camera…

Page 25: How To Make Multi-Robots Formation Control System

11/12/01

Problems of image recognition Image Capture Resolution:640x480

・Inside pattern of markers are broken and lost information in 640x480 capture resolution. (This is not improved very much if I use large size of markers) ・Normal printed markers on a paper shine by light.

Problem

Impossible!

Page 26: How To Make Multi-Robots Formation Control System

11/12/01

Problems of image recognition

・made black parts of markers with not paper but cloth ・changed capture resolution to 960x720 ・tune camera’s exposure setting ・tune camera position & direction ・Redesign marker pattern with Error Correction Code

Page 27: How To Make Multi-Robots Formation Control System

11/12/01

Marker Detection Binarize

Edge tracing Corner Detection

Dilation & Erosion

Template Matching

Labeling

Page 28: How To Make Multi-Robots Formation Control System

11/12/01

Homography Calcuration

Calibrating by 4-point algorithm previously

Convert initial view to top view and control robots positions to be a desired shape

Page 29: How To Make Multi-Robots Formation Control System

11/12/01

Design of Error Correction Code Reed-Solomon Code Ex) CD, QR Code

I gave up to adopt this because of implementing cost

Hamming Code

I adopted this because implementation is simple

・1bit error can be corrected

Page 30: How To Make Multi-Robots Formation Control System

11/12/01

Implementation of iPad Event Handling

WiFi

Web Server (Jetty)

Matlab

Xbee Service

Send touch events by Ajax

Image Recognition

Robots Control

Page 31: How To Make Multi-Robots Formation Control System

11/12/01

Implementation of Feedback Control PID Control

P(Proportional gain) I(Integral gain) D(Derivative gain)

Time

Difference

Time

Difference

Control input value in proportion to a difference

Eliminate a offset by integrating differences

Offset

Time

Difference

Improve response sensitivity by derivative of difference

Page 32: How To Make Multi-Robots Formation Control System

11/12/01

… Then I can all the way to make my system. I wanted to implement collision avoidance system but I didn’t have time…

Page 33: How To Make Multi-Robots Formation Control System

11/12/01

Final System Design

WiFi

ZigBee Wireless communication

USB Camera (Detect Robots Positions)

Stroke Input on iPad Swarm Robots (with Omni-Wheels)

PC 2D Code

(with Error Correction)

Page 34: How To Make Multi-Robots Formation Control System

11/12/01 http://d.hatena.ne.jp/Cherenkov/20101115/p1

A Scene of Idea Contest Exhibition

Picture by @Cherenkov Thanks!

Controlling a swarm of robots by drawing on your iPad

Page 35: How To Make Multi-Robots Formation Control System

11/12/01

You can watch a movie on YouTube

http://www.youtube.com/watch?v=SzXFGeB6Hxs

Page 36: How To Make Multi-Robots Formation Control System

11/12/01

Thanks!

Keisuke UTO @utotch