RoboCupRescue 2009 - Robot League Team SAE Robotique (Canada)

Simon St-Pierre

SAE Robotique Ecole Polytechnique de Montreal; Ecole Polytechnique of Montreal

http://saerobot.polymtl.ca/


Abstract This paper outlines SAE Robotique entry to the RoboCupRescue competition with L'Éclaireur, its first Urban Search And Rescue (USAR) Robot prototype. Team approach was to create a sturdy platform that will allow Sensor integration, Electronic and Software development in the next years while improving mechanical design.

Introduction

SAE Robotique is a group of students of the Ecole Polytechnique of Montreal. Its mission is to insure to future engineers a complement to their academic formation offering to them the unique chance to participate in a multidisciplinary project directly linked to the industrial reality. Our goal is to provide a work experience centered on practical work, the application of theoretical notions and to develop work group and interpersonal relations abilities. The work is voluntarily done by the students during their free time.

Created in 1991, SAE Robotique team originally intended to participate to the SAE Walking Machine Challenge. Over the years, different prototypes were built:

After the end of SAE Walking Machine Challenge, SAE Robotique decided in 2007 to design a USAR robot which has a concrete and humanitarian application. After two years of development SAE Robotic is proud to present its fist prototype: L'Éclaireur.

During the first year, the team designed the shape of the robot, its locomotion system, the robotic arm, electronic components and selected sensors and peripherals. The robot construction, assembly and programming took place in the second year.

In the next years, our goal will be to focus on Software development to generate a high precision map. Once this will be accomplished, Software development will move toward autonomous exploration and victim detection.

The mechanical team will continuously improve the main frame of the robot to allow greater speed and manoeuvrability. If major modifications to the robot are needed, a new prototype will be designed.

Team logo and header image
Team logo and header image
Historical prototypes of SAE Robotique robots
Historical prototypes of SAE Robotique robots
Historical prototypes of SAE Robotique robots
Historical prototypes of SAE Robotique robots
Historical prototypes of SAE Robotique robots
Historical prototypes of SAE Robotique robots
Historical prototypes of SAE Robotique robots
Historical prototypes of SAE Robotique robots
Historical prototypes of SAE Robotique robots
Historical prototypes of SAE Robotique robots

1. Team Members and Their Contributions

Simon St-Pierre Project Manager, Electrical Design (Power Distribution, Motor Control)

Pierre-Luc Bourgeois Mechanical Design (Drive Train, Propulsion, Front Arms )

Patrick Mutchmore Software Design (Platform, Device Drivers)

Alexandre Villeneuve Mechanical Design (Chassis, , Robotic Arm), Robot Assembly

Marc Blondin Mechanical Design (Robotic Arm Modifications)

Luan Luan Mechanical Design (Robotic Arm's Head Modifications)

David Laporte Software Design (Graphical User Interface)

Jérémie Galarneau Software Design (Device Drivers) Christian Babeux Software Design (Device Drivers) Alexandre Monette Software Design (Joystick Control) Etienne Bolduc Software Design (Map generation) Jonathan Ménard Electrical Design (Robotic Arm Control) Mehdi Mahmoudi Electrical Design (Robotic Arm Control)

2. Operator Station Set-up and Break-Down (10 minutes)

  • Set-Up
    • Boot-Up Robot Computer
    • Boot-Up Operator Station Computer
      • o Connect Printer
      • o Connect Joystick
      • o Launch Server, GUI and other programs
      • o Launch Client on the robot (via SSH)
    • If robot is still on AC/DC Power Supply, disconnect it to run only on battery.
    • Bring the robot to the starting point
    • Power-Up all robot's peripheral.
  • Break-Down
    • Power-Down all robot's peripheral.
    • Shutdown robot computer (via SSH)
    • Shutdown Operator Station Computer
    • Disconnect Printer and Joystick from Operator Station Computer

3. Communications

ROBOT

  • D-Link® Xtreme N™ Duo Wireless Bridge/Access Point (DAP-1522)

OPERATOR STATION COMPUTER

  • Intel® Wireless WiFi Link 4965AGN

We will use the DAP-1522 to generate a simple wireless network. Three setup in the 5 Ghz band are possible: 802.11a only, 802.11n only, or mixed 802.11n and 802.11a. Further tests are needed to determine which offers the best range/bandwidth ratio.

Another DAP-1522 might be used instead of the 4965AGN on the operator station computer if a bridge configuration offers better performance.

D-Link Xtreme N Wireless Bridge/Access Point (Robot side)
D-Link Xtreme N Wireless Bridge/Access Point (Robot side)
D-Link Xtreme N Wireless Bridge/Access Point (Robot side)
D-Link Xtreme N Wireless Bridge/Access Point (Robot side)
Intel Wireless WiFi Link 4965AGN (Operator Station)
Intel Wireless WiFi Link 4965AGN (Operator Station)

Rescue Robot League - SAE Robotique (Canada) Frequency and Power Settings

Rescue Robot League Frequency Channel/Band Power (mW)
SAE Robotique (Canada) 5.0 GHz - 802.11a
5.0 GHz - 802.11n

4. Control Method and Human-Robot Interface

The robot will be manually controlled via the Logitech® Extreme™ 3D Pro Joystick. It has a USB interface.

Joystick controls include:

  • Steering
  • Front arm rotation
  • Robotic arm movement
  • Power ON/OFF/AUTO of the lighting system

Autonomous Behavior:

  • Victim Detection:
    • o Temperature level warning
    • o CO2 level waning
  • Ambient light detection and lighting system power ON/OFF

Mouse control:

  • Victim Detection:
    • o Validate if voice or sound was head
    • o Validate if movement was seen on the video camera
    • o Select victim state
    • o Select victim situation
    • o Video print screen of the victim (tag identification)
  • Map generation
    • o Manual modification of map if needed
    • o Manual victim localization on map if needed
  • Other:
    • o Tab selection
    • o Map Zoom

Graphical User Interface

  • Map visualization (top left)
  • Real-time video stream (top right tab)
  • Real-time laser view (top right tab)
  • 3-D view of robot tilt & front arms position (Bottom left tab)
  • Overview of all sensors (Bottom left tab)
  • Victim detection related sensors state (Bottom center)
  • Confirmed Victim information (Bottom right, New tab created for each victim)
  • First draft:
Logitech Extreme 3D Pro Joystick
Logitech Extreme 3D Pro Joystick
Graphical User Interface first draft
Graphical User Interface first draft

5. Map generation/printing

The map generation is based on the Simultaneous Localization And Mapping algorithm (SLAM). More specifically, we are using the FastSLAM algorithm[1].

The computer of the robot, a JRex-PM form Kontron will be used only for data acquisition and Sensor/Motor control.

All Data will be transferred to the Operator Station Computer to be analysed, i.e. map calculation and generation will be made on the Operator Station Computer. This allows for minimum requirement / power consumption on the robot computer and permit maximal computer processing on the Station Computer since it has no limitation.

Data input:

Hokuyo's URG-04LX

  • o Detectable range is 20mm to 4000mm
  • o 100msec/scan
  • o 240° area scanning range with 0.36° angular resolution
  • o USB interface

Sparkfun's 6DOF v2

  • o Three gyro readings from 3 ADXRS300
  • o Three tilt readings from the tripe axis accelerometer MMA7260Q
  • o Serial TTL interface

Motor encoder

  • o Provide robot speed
  • o Provide robot traveled distance

Manual modifications of map if needed:

  • Add/Remove obstacles
  • Correct position of victims
JRex-PM Robot Computer from Kontron
JRex-PM Robot Computer from Kontron
Hokuyo URG-04LX Laser Range Finder
Hokuyo URG-04LX Laser Range Finder
Sparkfun 6DOF v2 Inertial Measurement Unit
Sparkfun 6DOF v2 Inertial Measurement Unit

6. Sensors for Navigation and Localization

Navigation:

To help manual navigation, the Logitech® QuickCam® Communicate STX™ will provide a video feed. It has a USB interface.

Also, if the laser range finder detects an obstacle to close to the robot, the operator will be warned in the GUI. Similarly, if the accelerometer measures a critical tilt angle of the robot, the operator will be warn to make sure he will not flip the robot upside-down.

Localization: See section 5: Map generation.

Logitech QuickCam Communicate STX Camera
Logitech QuickCam Communicate STX Camera
Logitech QuickCam Communicate STX Camera
Logitech QuickCam Communicate STX Camera

7. Sensors for Victim Identification

Please use this section to describe the sensors you use for victim navigation [tactile, acoustic, ultrasonic, infrared, visual, laser, chemical, encoder, other], and explain how you use them.

Movement & Form Detection

The Logitech® QuickCam® Communicate STX™ will be used to detect movement and human body form.

C02 Detection

The Miniature Optical (NDIR) Carbon Dioxyde CO2 Sensor form AIR MONITORS Ltd. will be used to detect CO2 level. It has a serial TTL interface.

Miniature Optical Carbon Dioxide CO2 Sensor from AIR MONITORS Ltd.
Miniature Optical Carbon Dioxide CO2 Sensor from AIR MONITORS Ltd.

Body Heat Detection

The 8 Pixel Thermal Array Sensor form Devantech Ltd. will be used to detect body heat.

The I2C output of the sensor will be connected to the Devantech Ltd. USB to I2C Interface Module to be interpreted directly on the computer.

8 Pixel Thermal Array Sensor from Devantech Ltd.
8 Pixel Thermal Array Sensor from Devantech Ltd.
Devantech USB to I2C Interface Module
Devantech USB to I2C Interface Module

Sound Detection

The microphone on the Logitech® QuickCam® Communicate STX™ will be used to detect different sounds. It will be placed in a cylindrical tube to enhance the range (faint moaning up to 10 meters) and limit the robot noise capitation that will cover the sound of interest.

8. Robot Locomotion

Main Frame:

Dimensions (aluminium chassis + track width):

o Length : 24"

o Width : 25"

o Height : 8"

o Length totally deployed: 33"

Robot Main Frame
Robot Main Frame

4 tracks system

o 2 for the differential steering,

  • o 2 for the front arms.

Propulsion:

  • 4 Maxon motor : RE 40 Ø40 mm, Graphite Brushes, 150 Watt. (148867)
  • 4 Encoders HEDS 5540, 500 Counts per turn, 3 Channels (110513)
  • Gearhead:
    • o 2 Planetary Gearhead GP 42 C Ø42 mm, 3 15 Nm, 113:1 (203126) for the propulsion
    • o 2 Planetary Gearhead GP 52 C Ø52 mm, 4 30 Nm, 257:1 (223102) for the front arms independent rotation.
  • 2 Roboteq AX-2850 Dual axis 120A motor controllers
Roboteq AX-2850 Dual Axis Motor Controller
Roboteq AX-2850 Dual Axis Motor Controller

9. Other Mechanisms

A 5 degrees of liberty robotic arm will be used to look in hard to reach areas :

First prototype:

5 Degrees of Freedom Robotic Arm
5 Degrees of Freedom Robotic Arm
First Robotic Arm Prototype
First Robotic Arm Prototype
First Robotic Arm Prototype
First Robotic Arm Prototype
First Robotic Arm Prototype
First Robotic Arm Prototype
Lynxmotion Base Rotate Kit
Lynxmotion Base Rotate Kit
Lynxmotion Pan and Tilt Kit
Lynxmotion Pan and Tilt Kit
Robotic Arm Head Assembly
Robotic Arm Head Assembly
Robotic Arm Head with Accelerometer Board
Robotic Arm Head with Accelerometer Board
Mean Well S-350-24 AC/DC Power Supply
Mean Well S-350-24 AC/DC Power Supply
NiMH Battery Pack 24V 10Ah
NiMH Battery Pack 24V 10Ah

10. Team Training for Operation (Human Factors)

Please use this section to describe what kind of training is required to use your system, and what kind of skills are beneficial for operators of your system. Also, how you went about training your team members for the competition.

  • GUI Training:
    • Learn basic functions and victim confirmation
    • Learn warnings & appropriate response
    • Learn map related functions
  • Robot Control Training:
    • Learn mix control of the robot steering / robotic arm movement with the joystick.
    • Lean other robot functions
  • < 10 minute start-up sequence training

11. Possibility for Practical Application to Real Disaster Site

Our robot is design for sturdiness and obstacle crossing. All calculations were done with a security factor of 2. All robot mechanical components are in aluminium; chassis, transmission and drive-train parts had a core thermal treatment.

Robot demonstrating obstacle crossing capability
Robot demonstrating obstacle crossing capability

12. System Cost

All listed price are in $CAN, taxes & shipping included.

System Cost - Sensors, Peripherals & Components

Part Quantity Unit price Total Price
AIR MONITORS Ltd. Miniature CO2 Sensor 1 500,00 $ 500,00 $
Devantech Ltd. Thermal Array Sensor 1 130,00 $ 130,00 $
Devantech Ltd. USB to I2C Interface Module 1 55,00 $ 55,00 $
Lighting System 1 300,00 $ 300,00 $
Speaker- communication System 1 100,00 $ 100,00 $
Hokuyo URG-04LX 1 3 300,00 $ 3 300,00 $
Roboteq AX-2850 2 920,00 $ 1 840,00 $
Sparkfun 6DOF v2 1 431,25 $ 431,25 $
Sparkfun's breakout board 2 axis ADXL320 1 45,00 $ 45,00 $
Logitech® QuickCam® Communicate STX™ 1 100,00 $ 100,00 $
Robot Power Distribution 1 1 000,00 $ 1 000,00 $
Mean Well S-350-24 PSU 2 51,00 $ 102,00 $
Battery 24V 10Ah 2 375,00 $ 750,00 $
Electronic components - - 500,00 $
Printed circuit fabrication - - 300,00 $
Total Sensors, Peripherals & Components 9 453,25 $

System Cost - Control & Communication

Part Quantity Unit price Total Price
D-Link® Xtreme N™ (DAP-1522) 1 120,00 $ 120,00 $
Kontron JRex-PM 1 800,00 $ 800,00 $
Logitech® Extreme™ 3D Pro 1 60,00 $ 60,00 $
Total Control & Communication 980,00 $

System Cost - Mechanical Components & Machining

Part Quantity Unit price Total Price
Unmachined raw material - - 300,00 $
Front arm and Drive train machining - - 7 000,00 $
Chassis machining - - 400,00 $
Drive train gears, ball bearings & pulley - - 1 200,00 $
Robot Tracks & wheels - - 1 613,08 $
Motor + gear heads + encoders 4 1 000,00 $ 4 000,00 $
Robotic arm raw material - - 150,00 $
Lynxmotion Base Rotate Kit 1 28,00 $ 28,00 $
Hitec HS-645MG 1 52,00 $ 52,00 $
Hitec HSR-5980SG 4 165,00 $ 660,00 $
Lynxmotion Pan and Tilt Kit 1 56,00 $ 56,00 $
Robotic arm's Head machining - - 200,00 $
Special Tooling - - 215,00 $
Total Mechanical components & machining 15 874,08 $

Robot cost: 26 307,33 $CAN

References

[1] Thrun, S., Burgard, W., Fox, D.,: Probabilistic Robotics. The MIT Press, (2006), 647p.