HAPTIC CONTROL AND OPERATOR-GUIDED GAIT COORDINATION OF A PNEUMATIC HEXAPEDAL RESCUE ROBOT

Preview:

DESCRIPTION

HAPTIC CONTROL AND OPERATOR-GUIDED GAIT COORDINATION OF A PNEUMATIC HEXAPEDAL RESCUE ROBOT. A Master’s Thesis Presentation By Brian A. Guerriero Georgia Institute of Technology George W. Woodruff School of ME Intelligent Machine Dynamics Lab - PowerPoint PPT Presentation

Citation preview

CCEFP TB4 Brian Guerriero

HAPTIC CONTROL AND OPERATOR-GUIDED GAIT COORDINATION OF A

PNEUMATIC HEXAPEDAL RESCUE ROBOTA Master’s Thesis Presentation

By

Brian A. GuerrieroGeorgia Institute of TechnologyGeorge W. Woodruff School of MEIntelligent Machine Dynamics Lab

NSF Center for Compact and Efficient Fluid Power

Dr. Wayne Book

CCEFP TB4 Brian Guerriero

Introduction

NSF CCEFP Paving the way in improving

the compactness, efficiency, and effectiveness of fluid power

7 member universities 3 thrusts 4 testbeds

CCEFP TB4 Brian Guerriero

Introduction

Testbed 4: Compact Rescue Crawler Develop testbed for man-machine

multimodal interface research Research bilateral teleoperation

and coordinated pneumatic control Research methods of enabling a

single operator to control an 18 DoF mobile robot

Use PHANToM haptic devices to wield control over two robot legs

CCEFP TB4 Brian Guerriero

Introduction

CCEFP Collaborator Roles Vanderbilt University

Develop chemofluidic monopropellant fuel source and components

Develop high-level automatic gait coordination

NCAT Evaluate human factors issues

regarding operator interface Evaluate optimum methods for feeding

large amounts of data effectively to operator

CCEFP TB4 Brian Guerriero

Acknowledgements

Dr. Wayne Book

Dr. Chris Paredis

Dr. Harvey Lipkin

JD HugginsOthers:

Dr. Matt Kontz

IMDL Labmates

Friends & Colleagues

Dr. Haihong Zhu

CCEFP TB4 Brian Guerriero

Acknowledgements

Industry Support and Sponsors

CCEFP TB4 Brian Guerriero

PresentationOutline

Background Research Pneumatic Control High Level Gait Coordination

CRC V1.0CRC V2.0

Design Sensors System Configuration

Control Classical Methods Revised Force-based Position Controller

User Interface Haptic Feedback Operator Workstation

Guided-Gait CoordinationConclusions & Next Steps

CCEFP TB4 Brian Guerriero

PresentationOutline

Background Research Pneumatic Control High Level Gait Coordination

CRC V1.0CRC V2.0

Design Sensors System Configuration

Control Classical Methods Revised Force-based Position Controller

User Interface Haptic Feedback Operator Workstation

Guided-Gait CoordinationConclusions & Next Steps

CCEFP TB4 Brian Guerriero

Background Research

Pneumatic Servo Control Wang, Pu, Moore: acceleration feedback instead of pressure

Chillari, Guccione, Muscato: Survey of pneumatic control schemes Differential pressure gain scheduling Fuzzy, Neuro-Fuzzy, Sliding mode

Guvenc: Discrete time model regulation with model inversion

Korondi and Gyeviki: robust sliding mode control

CCEFP TB4 Brian Guerriero

Background Research

Chemofluidic Monopropellant Research Goldfarb, Barth, Fite, Mitchell, Shields, Gogola, Wehrmeyer: Control, characterization and implementation techniques

Al-Dakkan, Goldfarb, Barth: Energy saving techniques reusing high-pressure exhaust gasses

CCEFP TB4 Brian Guerriero

Background Research

High Level Gait Coordination Cruse: Stick insect cauausius morosus gait analysis, developed WALKNET

Wait and Goldfarb: Further WALKNET development, application to a legged robot and simulations

Torige, Noguchi, Ishizawa: Centipede style gaits moving feet in waves based on previous foot positions

CCEFP TB4 Brian Guerriero

PresentationOutline

Background Research Pneumatic Control High Level Gait Coordination

CRC V1.0CRC V2.0

Design Sensors System Configuration

Control Classical Methods Revised Force-based Position Controller

User Interface Haptic Feedback Operator Workstation

Guided-Gait CoordinationConclusions & Next Steps

CCEFP TB4 Brian Guerriero

CRC V1.0

Developed from Vanderbilt design

7/8” Airpel/Sentrinsic Actuators

3 DoF, Good Range of Motion

CCEFP TB4 Brian Guerriero

CRC V1.0

Dec. 06 – Apr. 07 Mounted to table Simple PID Control

CCEFP TB4 Brian Guerriero

CRC V1.0

Problems and Issues No-stiction cylinders proved difficult to control, 100 psi MAX

Weak shoulder joint design Mechanical interferences

CCEFP TB4 Brian Guerriero

CRC V1.0

V1.0 In Action

CCEFP TB4 Brian Guerriero

PresentationOutline

Background Research Pneumatic Control High Level Gait Coordination

CRC V1.0CRC V2.0

Design Sensors System Configuration

Control Classical Methods Revised Force-based Position Controller

User Interface Haptic Feedback Operator Workstation

Guided-Gait CoordinationConclusions & Next Steps

CCEFP TB4 Brian Guerriero

CRC V2.0

4-07 - Present Complete and thorough two-legged redesign

Designed for 300 psi actuation

New prototype Sentrinsic cylinders

CCEFP TB4 Brian Guerriero

CRC V2.0Design Benefits

Shoulder Joints Clevis system eliminates slop and wear

CCEFP TB4 Brian Guerriero

CRC V2.0Design Benefits

Larger Actuators 1.5” pneumatic cylinders: 530 lbf at 300psi operating pressure

Valves mounted on or as close as possible to cylinders

CCEFP TB4 Brian Guerriero

CRC V2.0Design Challenges

Range of Motion Decreased due to larger cylinders Prevent mechanical interferences

Safety Robots Hurt!

Integration Sensors, valves and actuators packaged together

CCEFP TB4 Brian Guerriero

CRC V2.0Fabrication

Aluminum Leg Profiles Waterjet cut at GTRI and finished at ME shop

CCEFP TB4 Brian Guerriero

CRC V2.0Fabrication

Senrinsic Cylinders Designed and built by Sentinsic at GT

Custom rod ends and base clevises NFPA tie-rod design and fiber-wound barrel construction

Months of development, fabrication, debugging and revisions

CCEFP TB4 Brian Guerriero

CRC V2.0Fabrication

Senrinsic Cylinders 0-10V position output Integrated pressure sensors

CCEFP TB4 Brian Guerriero

CRC V2.0Sensors

Position CCRS integrated into cylinders

Pressure Measurement Specialties 250 psi MEMS sensors

CCEFP TB4 Brian Guerriero

CRC V2.0Sensors

Pressure Tested for linearity

Custom housings integrated into ends of cylinders

CCEFP TB4 Brian Guerriero

CRC V2.0Sensors

Sensor Integration Op-amp board developed for 12x pressure sensors

Custom PCB routes all power, sensors and valve commands

CCEFP TB4 Brian Guerriero

CRC V2.0System Integration

Onboard Computing PC-104+ stack runs real-time control via xPC Target

802.11n wireless data transfer 32 16-bit Analog inputs 16 12-bit Analog outputs

CCEFP TB4 Brian Guerriero

PresentationOutline

Background Research Pneumatic Control High Level Gait Coordination

CRC V1.0CRC V2.0

Design Sensors System Configuration

Control Classical Methods Revised Force-based Position Controller

User Interface Haptic Feedback Operator Workstation

Guided-Gait CoordinationConclusions & Next Steps

CCEFP TB4 Brian Guerriero

Control

Transformations

Joint Space (θ1, θ2, θ3)

PHANToM/operator Cartesian space

Cylinder Space

CCEFP TB4 Brian Guerriero

Control

Stroke Control Cylinder stroke length command converted into 0-10V command

Festo Proportional Valves control flow into each cylinder

CCEFP TB4 Brian Guerriero

Control

Goals Stability

Pneumatic systems are high-order and traditionally difficult to control

Tracking performance Each cylinder under highly varying loading conditions Target: 10%

Robust to disturbancesNoise and debris impacts

CCEFP TB4 Brian Guerriero

Control

Original PD Control Control effort based on position error only

Stable, worked well in original configuration

5

PD p d

valve PD

y k e k e

V y

CCEFP TB4 Brian Guerriero

Control

Two-Legged PD Control (Mounted)

CCEFP TB4 Brian Guerriero

Control

Critical Flaw When weight applied to legs, control effort not high enough

Large position errors

Crawler could not actually crawl

CCEFP TB4 Brian Guerriero

Control

Tracking

Response

90 95 100 105 1100

0.5

1

Cylinder L1

90 95 100 105 1100

0.5

1

Str

oke

Leng

th (

in.)

Cylinder L2

90 95 100 105 1100

0.5

1

Time (s)

Cylinder L3

CCEFP TB4 Brian Guerriero

Control

Two-Legged PD Control (Struggling)

CCEFP TB4 Brian Guerriero

Control

Improvements

Velocity damping term

Differential pressure gain scheduler

1

2

3

4

: 0, 0

: 0, 0

: 0, 0

: 0, 0

5

dp

dp

dpdp

dp

valve PD dp

p k p e

p k p ey

p k p e

p k p e

V y y

Addition of velocity feed-forward command

PD p ref act d act vff refy k x x k x k x

CCEFP TB4 Brian Guerriero

Control

Results Supplementary force control improved tracking

Crawler developed a ‘hopping’ syndrome, decreasing stability

5valve PD dpV y y

CCEFP TB4 Brian Guerriero

Control

Hopping syndrome

CCEFP TB4 Brian Guerriero

Control

Results Hopping caused by instantaneous gain change from position error sign change

1

2

3

4

: 0, 0

: 0, 0

: 0, 0

: 0, 0

5

dp

dp

dpdp

dp

valve PD dp

p k p e

p k p ey

p k p e

p k p e

V y y

CCEFP TB4 Brian Guerriero

Control

60 65 70 75 800

0.5

1

Cylinder L1

60 65 70 75 800

0.5

1

Str

oke

Leng

th (

in.) Cylinder L2

60 65 70 75 800

0.5

1

Time (s)

Cylinder L3

xref

x actual

CCEFP TB4 Brian Guerriero

Control

Solution Scale force supplement by position error and differential force

1

2

3

4

: 0, 0

: 0, 0

: 0, 0

: 0, 0

5

dp

dp

dpdp

dp

valve PD dp

p k p e

p k p ey

p k p e

p k p e

V y y

1

2

3

4

: 0, 0

: 0, 0

: 0, 0

: 0, 0

5

dfe e

dfe e

dfedfe e

dfe e

valve PD dfe

F k e k F e

F k e k F ey

F k e k F e

F k e k F e

V y y

CCEFP TB4 Brian Guerriero

Control

45 50 55 60 650

0.5

1

Cylinder L1

45 50 55 60 650

0.5

1

Str

oke

Leng

th (

in.)

Cylinder L2

45 50 55 60 650

0.5

1

Time (s)

Cylinder L3

xref

xact

CCEFP TB4 Brian Guerriero

Control

Improved force-based position control

CCEFP TB4 Brian Guerriero

PresentationOutline

Background Research Pneumatic Control High Level Gait Coordination

CRC V1.0CRC V2.0

Design Sensors System Configuration

Control Classical Methods Revised Force-based Position Controller

User Interface Haptic Feedback Operator Workstation

Guided-Gait CoordinationConclusions & Next Steps

CCEFP TB4 Brian Guerriero

User Interface

Operator Workstation Reconfigurable task-space

Initial Augmented Reality (AR) setup

CCEFP TB4 Brian Guerriero

User Interface

Operator Tasks Feel environment and obstacles

PHANToM haptic devices

See and hear environmentHead-mounted displayPTZ camera onboard robot

Ancillary functions Tactile switches on PHANToMsVoice recognition

CCEFP TB4 Brian Guerriero

User Interface

Haptic Interface PHANToM force output

Directional

Proportional to position error

Spring force

80 85 90 95 100 105 110-4

-3

-2

-1

0

1

2

3

4

Time (s)

For

ce (

y-ax

is)

(N)

Haptic Force, Y-axis, Full controller

CCEFP TB4 Brian Guerriero

User Interface

Immersive Environment Head-mounted display of feeds operator robot’s-eye-view

Motion tracker translates head movements into camera movement

CCEFP TB4 Brian Guerriero

User Interface

Head-Camera Interface

CCEFP TB4 Brian Guerriero

User Interface

Ancillary Functions Operator communications with high-level gait controller

Voice and tactile methods Visual robot status feedback

FuelLeg positionsNoise alerts

CCEFP TB4 Brian Guerriero

PresentationOutline

Background Research Pneumatic Control High Level Gait Coordination

CRC V1.0CRC V2.0

Design Sensors System Configuration

Control Classical Methods Revised Force-based Position Controller

User Interface Haptic Feedback Operator Workstation

Guided-Gait CoordinationConclusions & Next Steps

CCEFP TB4 Brian Guerriero

Guided-Gait Coordination

High Level Control Operator must wield control over 18 degrees of freedom

WALKNET coordination ideal for smooth flat terrain and simple commands

WALKNET coordination not sufficient for maneuvering through debris

CCEFP TB4 Brian Guerriero

Guided-Gait Coordination

Tiers of CRC Control1.WALKNET Gait Coordination

Simple operator commands i.e. ‘Forward’ or ‘Left’

2.Guided-Gait CoordinationOperator haptically places front legs, rear pairs follow

3.Complete ControlOperator haptically controls any leg (Extreme maneuvering)

CCEFP TB4 Brian Guerriero

Guided-Gait Coordination

Guided-Gait

Outline

L1 R1

R2

R3

L3

L2

CCEFP TB4 Brian Guerriero

Guided-Gait Coordination

Trajectory Recording Record foot trajectories made haptically

Smooth trajectory with a spline

0 2 4 6 8 10 12 14 16 18-200

0

200PHANToM x

0 2 4 6 8 10 12 14 16 180

100

200

300

PH

AN

ToM

inpu

t (m

m) PHANToM y

0 2 4 6 8 10 12 14 16 18-100

-50

0

50

Time (s)

PHANToM z

Raw Trajectory

Splined Trajectory

-150-50

50150 -200

-100

0

1000

100

200

300

z (mm)x (mm)

y (m

m)

CCEFP TB4 Brian Guerriero

Guided-Gait Coordination

Stepping Stones Each trajectory Ti is a map between two known safe points

Coordinate transforms relate robot position to inertial reference frame

W pr updated each cycle

(distance from origin)

CCEFP TB4 Brian Guerriero

Guided-Gait Coordination

Successive Leg Pairs Recorded trajectories played through rear legs

Master list of stepping stones and trajectories

CCEFP TB4 Brian Guerriero

Guided-Gait Coordination

Conditions and Goals Maintain forward progress

“Move rear legs to the most anterior reachable stepping stone” “Advance body until one leg reaches its posterior extreme point”

Operator must tell coordinator when to move a set of legs

Operator gives cue to the controller to begin body advancement

CCEFP TB4 Brian Guerriero

Guided-Gait Coordination

Body Advancement Body advances by moving all six feet rearward at the same rates

Advancement stops when one leg is at its posterior extreme position

CCEFP TB4 Brian Guerriero

Guided-Gait Coordination

CCEFP TB4 Brian Guerriero

Guided-Gait Coordination

CCEFP TB4 Brian Guerriero

PresentationOutline

Background Research Pneumatic Control High Level Gait Coordination

CRC V1.0CRC V2.0

Design Sensors System Configuration

Control Classical Methods Revised Force-based Position Controller

User Interface Haptic Feedback Operator Workstation

Guided-Gait CoordinationConclusions & Next Steps

CCEFP TB4 Brian Guerriero

Conclusions & Next Steps

Robot Construction Two legged robot design is robust, easy to maintain, and reliable

Future Work Stiffen spine Package computers & PSUs Integrate VU H2O2 technology

CCEFP TB4 Brian Guerriero

Conclusions & Next Steps

Control Foot position tracks operator commands to within 10% under all normal load conditions

Future Work Improve tracking to 5% Improve haptic feedback so that operator applies no more than 1/6 robot weight to an obstacle before detection

CCEFP TB4 Brian Guerriero

Conclusions & Next Steps

User Interface Operator workstation in place and operational

Future Work Improve AR overlays Integrate work from NCAT collaborators optimizing data feed to operator Implement sensors and tools necessary for mission success

CCEFP TB4 Brian Guerriero

Conclusions & Next Steps

Guided-Gait Coordination Trajectory recording in place Overall algorithm ready for implementation

Future Work Develop software of gait controller Develop simulation of rear four legs Integrate functions of controller

CCEFP TB4 Brian Guerriero

Thank YouQuestions?

Recommended