Research Article

Constraint Satisfaction for Motion Feasibility Checking

Table 5

Mapping pose references to CSP variables.

ActionBounded parametersPose referencesCSP variables

MoveBasepr2,Oinit,Breach
ForPickUpobjeect03Binit,
Breach

PickUpGeneralpr2,Oinit,Hpre,
rgripper,Hinit,Hgrasp,
object03Hpre,Hpost
Hgrasp,

MoveBasepr2,Breach,Bplace
ForPutDownobject03,Bplace
table02
PutDownGeneralpr2,Oplace,Hlow,
rgripper,Hinit,Hplace,
object03Hlow,Hret
table02Hplace,
Hret