Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · •...

70
Reconciling Geometric Planners with Physical Manipulation Siddhartha Srinivasa Associate Professor The Robotics Institute, CMU www.cs.cmu.edu/~siddh Director The Personal Robotics Lab

Transcript of Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · •...

Page 1: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Reconciling Geometric Planners with

Physical Manipulation

Siddhartha SrinivasaAssociate Professor

The Robotics Institute, CMUwww.cs.cmu.edu/~siddh

DirectorThe Personal Robotics Lab

Page 2: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 3: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 4: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 5: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 6: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

PhysicalManipulation

GeometricSearch

Page 7: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

PhysicalManipulation

GeometricSearch

ManipulationPerception Systems

Navigation LearningParallelism Control

3D ModelingHRI

Page 8: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 9: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 10: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Manipulation Planning

Page 11: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Constraints

Page 12: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Constraints

Pose

Page 13: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Constraints

Torque

Page 14: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Constraints

Balance

Page 15: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Constraints

Closed Chains

Page 16: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Constraints

Underactuation

Page 17: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Affordances

Goal Sets

Page 18: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Affordances

Goal Sets

Page 19: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 20: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Why is this hard?

Page 21: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

3DOF Planar Manipulator

Heavy Object(Torque Constraint)

Sliding Surfaces(Pose Constraint)

Representation

Page 22: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

a:

e:

ae

Representation

Page 23: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

a:

e:

ae

Search

Page 24: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

c

e

b

a

d

a

b

c

d

e

Page 25: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 26: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Task Space Regions

cBiRRT

Page 27: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Start

Goal

obstacle

Page 28: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

qnear

qrand

Start

Page 29: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

qnear

qrand

Start

Page 30: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Will this work?• Properties of P

• Implementing P

• Manifold Coverage

• Exploration

• Probabilistic Completeness

• How does it work on a real robot?

Page 31: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Yes [IJRR’11]• Properties of P [ICRA’10]

• Implementing P [ICRA’09a,b]

• Manifold Coverage [ICRA’10]

• Exploration [ICRA’10]

• Probabilistic Completeness [ICRA’10]

• How does it work on a real robot?[ICRA’09a,b IROS’09 Humanoids’09]

Page 32: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 33: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

PhysicalManipulation

GeometricSearch

ManipulationPerception Systems

Navigation LearningParallelism Control

3D ModelingHRI

Page 34: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Failure : Uncertainty

Page 35: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Failure : Uncertainty

Page 36: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

?

Page 37: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 38: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Departing Kinematics

Page 39: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Exploit the Mechanics of Manipulationto Funnel Uncertainty [Mason’81, Burridge et al.’99]

Page 40: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Why not just open the hand wide and sweep?

Page 41: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Clutter

Page 42: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

?

Page 43: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 44: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

The Details of Push-Grasping

Mechanics• What are the consequences of a push?• How much does the robot need to know?

Method• How do we address uncertainty?• How do we plan in clutter?

Validation• Is our model of mechanics realistic?• Does push-grasping work on a real robot?

Page 45: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Quasi-Static Pushing

How much should the robot know?• Object mass? No.

• Object-surface friction? No.

• Object pressure distribution? Pick conservatively.

• Finger-object friction? Pick conservatively.

The Voting Theorem[Mason’81]

The Limit Surface[Goyal et al.’91, Howe and Cutkosky’96]

Page 46: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

The Push-Grasp

• Hand pose: ph=(x,y,q)

• Aperture: a

• Pushing direction: v

• Pushing distance: d

Push-Grasp: G(ph,a,d)

Page 47: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

The Capture Region

• Capture Region: C(G,O)– Set of all poses of object O that results in a successful

push-grasp for G

Page 48: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Example Capture Regions

Page 49: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Understanding Capture Regions

Page 50: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Understanding Capture Regions

IV, VI: Object contour

Page 51: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Understanding Capture Regions

IV, VI: Object contours

II, V: Caging regions

Page 52: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Understanding Capture Regions

IV, VI: Object contours

II, V: Caging regions

I, III: Pushing regions

Page 53: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Understanding Capture Regions

Page 54: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Addressing Object Pose Uncertainty

Vision

Reportedpose

UncertaintyRegion

Is included in capture region of a G?

Page 55: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 56: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

The Details of Push-GraspingBest Paper Award Finalist IROS 2010

Mechanics• What are the consequences of a push?• How much should the robot know?

Method• How do we address uncertainty?• How do we plan in clutter?

Validation• Is our model of mechanics realistic?• Does push-grasping work on a real robot?

Page 57: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 58: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 59: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

A Framework for Push-grasping in Clutter[RSS 2011 oral]

Slide-away

Sweep

Page 60: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

61

Page 61: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

62

Page 62: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

63

Page 63: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 64: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

PhysicalManipulation

GeometricSearch

ManipulationPerception Systems

Navigation LearningParallelism Control

3D ModelingHRI

Page 65: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 66: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

SensorDesign

ArmControl

TrajectoryOptimization

BehaviorEngine

HierarchicalPlanning

PeopleDetection

StructureDiscovery

CollaborativeManipulation

SkillLearning

Page 67: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

• BusinessWeekWorld's most advanced robots

• CBSRobots Soon To Become Part Of Home, Work Life

• Popular ScienceRise of the Helpful Machines: Meet 10 of the most advanced human-assist 'bots from around the world

• Fast CompanyIntel's Robot Butler Serves, Clears, and Does Dishes

• Wired MagazineButler Robot Can Fetch Drinks, Snacks

• NBC Bay AreaRobot Steals the Show at Intel Show-Off Day

• ABC San FranciscoIntel shows off new innovations on Research

• NSF Science NationHERB, the Robot Butler

• CMU Link MagazineRobots for Life

Page 68: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work
Page 69: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

CollaboratorsPeter Kaiser

Tim Niemueller

Peter Allen

Chris Atkeson

Drew Bagnell

Jodi Forlizzi

Martial Hebert

Takeo Kanade

Charlie Kemp

Sara Kiesler

Ross Knepper

James Kuffner

Min Kyung Lee

Matt Mason

Nancy Pollard

Ali Rahimi

Jim Rehg

Thierry Simeon

Joshua Smith

Rosen Diankov

Dave Ferguson

Garratt Gallagher

Casey Helfrich

Bart Nabbe

Nico Blodow

Maya Cakmak

Lillian Chang

Martin Herrmann

Geoff Hollinger

Laura Lindzey

Manuel Martinez

Alberto Rodriguez

Martin Rufli

Adam Rule

Alexander Sorokin

Andrew Yeager

Andres Vazquez

Julius Ziegler

Page 70: Siddhartha Srinivasa - Computer Science at RPItrink/RSS-2011/Presentations/sidd.pdf · • BusinessWeek World's most advanced robots • CBS Robots Soon To Become Part Of Home, Work

Reconciling Geometric Planners with

Physical Manipulation

Siddhartha SrinivasaAssociate Professor

The Robotics Institute, CMUwww.cs.cmu.edu/~siddh

DirectorThe Personal Robotics Lab