45
Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7- 11, 2002 Workspace Analysis in Multirobot Manipulation Ramon Costa-Castelló, Luis Basañez

Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Embed Size (px)

Citation preview

Page 1: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

Workspace Analysis in Multirobot Manipulation

Ramon Costa-Castelló, Luis Basañez

Page 2: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

CONTENTS

Introduction Basic Definitions Multirobot System Analysis

Dexterous Workspace Reachable Workspace

Application to RX-90 robot Dexterous Figure Construction Reachable Figure Construction

Two RX-90 cell Conclusions

Page 3: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

INTRODUCTION

Multirobot Cell

Page 4: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

INTRODUCTION

Multirobot Manipulation Advantages Load Capacity Increase

Dexterity Improvement

Flexible Objects

Multirobot Manipulation Drawbacks Coordination Needed

Workspace Reduction

Page 5: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

INTRODUCTION

Workspace Approaches Analytical Methods

• Singularity Analysis• Exact approach

Volumetric Methods• Workspace discretization• Approximation• Obstacles

Intersection Approach • Intersection of several geometric figures• Quicker approach• Work cell Design capabilities

Page 6: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

CONTENTS

Introduction

Basic Definitions Multirobot System Analysis

Dexterous Workspace Reachable Workspace

Application to RX-90 robot Dexterous Figure Construction Reachable Figure Construction

Two RX-90 cell Conclusions

Page 7: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

The kinematics f of a mechanism is the relation between the configuration space C and the operational space O

Workspace: elements of O in which the robot end-effector can be placed in

Reachable Workspace: set of positions reachable by the robot end-effector in at least one orientation

Dexterous workspace: set of positions reachable by the robot in all orientations

BASIC DEFINITIONS

f C O

|W x O C x f

| ( )nRW p R x R p W R SO n

| ( )nDW p R x W x R p R SO n

Page 8: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

CONTENTS

Introduction Basic Definitions

Multirobot System Analysis Dexterous Workspace Reachable Workspace

Application to RX-90 robot Dexterous Figure Construction Reachable Figure Construction

Two RX-90 cell Conclusions

Page 9: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSIS

0 0 0 0 1c i i i iC C C i N

i i i iB f O Individual kinematics

Multirobot System Configuration Space

Page 10: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSIS

0

0

0

0

i i i i i i

i i i

f B f i O B f i B

f B f i O

p R R p R p p

R R R R

Position and Orientation Constraining Equations

Page 11: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSISDexterous Workspace

Page 12: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSISDexterous Workspace

Page 13: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSISDexterous Workspace

Page 14: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSISDexterous Workspace

Page 15: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSISDexterous Workspace

Page 16: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSISDexterous Workspace

Page 17: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSISDexterous Workspace

Page 18: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

0

0 0| ( )

1i i ii i

o

nD i i

O B Bf

f

W x R R SO n C C

Rp R p p x i N

p x

Dexterous Workspace Definition

Expression Manipulation

MULTIROBOT SYSTEMS ANALYSIS

iDOB

TB

iDBOB

BiDBO

WpRpxRR

WRpRpxR

pWRpRxR

iii

iii

iii

,

,

,

iDOB

TB WppxRsph

iii ,

Page 19: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

Workspace

Dexterous Figure

Dexterous Figure definition

Dexterous Workspace from Dexterous Figure

MULTIROBOT SYSTEMS ANALYSIS

iDOBTB

iD

iD WppxRsphWxW

iii ,|ˆ

Ni

DiDD WWW

..1

Page 20: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSISReachable Workspace

Page 21: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSISReachable Workspace

Page 22: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSISReachable Workspace

Page 23: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSISReachable Workspace

Page 24: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSISReachable Workspace

Page 25: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSISReachable Workspace

Page 26: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSISReachable Workspace

Page 27: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSISReachable Workspace

Page 28: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

MULTIROBOT SYSTEMS ANALYSISReachable Workspace

Page 29: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

i oR R RW W W

Reachable Space Approximation

Reachable Figure Definition

Reachable Workspace from Reachable Figure

ReachableFigure

Workspace

MULTIROBOT SYSTEMS ANALYSISReachable Figure

0| , i i i i

n T iR R O O B R BW x R x W R x RR p R W p

| i i i i

i n T iR O O B R BW x R R x RR p R W p

Page 30: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

CONTENTS

Introduction Basic Definitions Multirobot System Analysis

Dexterous Workspace Reachable Workspace

Application to RX-90 robot Dexterous Figure Construction Reachable Figure Construction

Two RX-90 cell Conclusions

Page 31: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

RX-90 robot

APPLICATION TO RX-90 ROBOT

Page 32: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

RX-90 Configuration Space section

RX-90 Work Space section1 ctt

1 ctt

APPLICATION TO RX-90 ROBOT

Page 33: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

RX-90 3D WorkspaceRX-90 selected sections

APPLICATION TO RX-90 ROBOT

Page 34: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

RX-90 Dexterous Figure Construction Scheme

APPLICATION TO RX-90 ROBOTDexterous Workspace

Page 35: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

Reachable figure for

APPLICATION TO RX-90 ROBOTReachable Figure

mmpiO

50

Page 36: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

APPLICATION TO RX-90 ROBOTReachable Figure

Reachable figure for mmpiO

2000

Page 37: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

CONTENTS

Introduction Basic Definitions Multirobot System Analysis

Dexterous Workspace Reachable Workspace

Application to RX-90 robot Dexterous Figure Construction Reachable Figure Construction

Two RX-90 cell Conclusions

Page 38: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

1

1 0 0 500

0 1 0 0

0 0 1 461

0 0 0 1

mm

Omm

Cell Picture

TWO RX-90 CELL

1

1 0 0 846

0 1 0 1306

0 0 1 0

0 0 0 1

mm

mmB

mmpiO

08.680

Page 39: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

Reference Robot Workspace and Reachable Figure

TWO RX-90 CELL

Page 40: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

31 193534m 46 36%

TWO RX-90 CELLReachable Workspace

Page 41: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

CONTENTS

Introduction Basic Definitions Multirobot System Analysis

Dexterous Workspace Reachable Workspace

Application to RX-90 robot Dexterous Figure Construction Reachable Figure Construction

Two RX-90 cell

Conclusions

Page 42: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

• A new method to analyze multirobot workspace has been presented. The method is based in computing the intersection of the reference manipulator workspace and the reachable/dexterous figure of the other robots.

• The method has been applied to PUMA like manipulators.

• Further work : Introduction of orientation kinematics.

CONCLUSIONS

Page 43: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

Robots in the same Position and different Orientation

Page 44: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

Orientation Range Analysis

Page 45: Workspace Analysis in Multirobot Manipulation International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002 Workspace Analysis in Multirobot Manipulation

Wo

rksp

ace

An

aly

sis

in M

ult

iro

bo

t M

anip

ula

tio

n

International Symposium on Robotics Stockholm, Sweden. Oct 7-11, 2002

Further Works

Orientation Range Analysis through Analytic Methods

Automatic Work Cell Design (Position and Orientation)